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PREFACE 


1907 年 ,世界 上 第 一 架 四 旋 避 飞 行 器 成 功 升 空 , 拉 开 了 四 旋 惧 飞行 器 研究 的 大 幕 。 
四 旋 潜 飞行 器 的 研究 ,是 多 学 科 的 碰撞 和 结合 ,涉及 控制 理论 .电子 与 通信 理论 .图 像 处 
理 技 术 及 各 种 传感器 技术 ,也 与 材料 科学 等 学 科 密 切 相 关 。 

由 于 四 旋涡 飞行 器 相 较 于 固定 必 飞 行 器 具有 机 动 性 强 、 能 源 利用 率 高 .结构 设计 巧 
妙 和 安全 性 高 等 特点 , 相 较 于 地 面 机 器 人 具有 更 高 的 自由 度 ,因此 近年 来 已 成 为 一 个 研 
究 热点 ,不 仅 大 学 等 研究 机 构 进 行 了 广泛 而 深入 的 研究 ,以 大 疆 为 首 的 消费 级 四 旋 履 飞 
行 器 也 取得 了 爆发 式 的 发 展 。 

四 旋 愤 飞行 器 作为 一 个 载体 ,在 实现 基本 飞行 功能 的 基础 上 ,可 以 附加 各 种 不 同 的 
功能 ,这 也 是 四 旋 辟 飞行 器 的 最 大 魅力 之 一 。 近 年 来 还 出 现 了 各 类 新 型 无 人 机 ,如 自拍 
无 人 机 、 农 业 植保 无 人 机 和 快递 无 人 机 等 。 各 大 研究 机 构 开 发 的 室内 精确 定位 无 人 机 则 
能 实现 更 多 精细 化 的 工作 ,如 利用 无 人 机 搭建 垂直 村 落 .无 人 机 集群 化 协同 飞行 表演 等 。 

实现 四 旋 愤 飞行 器 自主 飞行 功能 的 基础 : 中 四 旋翼 飞 行 器 实现 自主 平衡 ; Ope 
飞行 器 在 有 遥控 的 情况 下 按照 和 斩 控 者 意愿 飞行 , 且 操作 难度 较 低 ; 四 四 旋翼 飞行 器 在 无 
遥控 情况 下 利用 附加 传感器 实现 定点 悬 停 和 位 移 控制 。 

对 于 初学 者 来 说 ,四 旋翼 飞行 器 基础 飞行 功能 的 实现 有 较 高 的 难度 ,不 仅 要 根据 飞 
行 原 理 装 配 四 旋涡 飞行 器 的 硬件 ,在 硬件 层面 保证 飞行 器 能 够 安全 稳定 飞行 ,而 且 要 进 
行 四 旋翼 飞行 器 软件 设计 ,尤其 是 较为 困难 的 底层 软件 设计 。 此 外 ,四 旋涡 飞行 器 参数 
的 调节 对 开发 者 来 说 也 是 巨大 的 挑战 。 

本 书 深入 浅 出 地 全 面 介绍 了 四 旋翼 飞行 器 的 各 方面 知识 ,让 读者 能 轻松 容易 地 进行 
学 习 。 各 章节 分 布 如 下 : 第 1 章 介绍 四 旋翼 飞行 器 的 历史 、 现 状 和 关键 技术 ; 第 2 章 介 
绍 四 旋涡 飞行 器 的 飞行 原理 ,包括 姿态 表示 、 姿 态 解 算 . 平 衡 控 制 算法 和 滤波 算法 ; 第 3 
章 介绍 四 旋翼 飞行 器 设计 中 常用 的 通信 协议 ; 第 4 章 介 绍 四 旋翼 飞行 器 上 常用 的 硬件 设 
备 ; 第 5 章 介 绍 四 旋翼 飞行 器 软件 系统 设计 ; 第 6 章 介绍 飞行 控制 模块 PCB 的 设计 及 四 
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旋 恤 飞行 器 的 组 装 经 验 和 调试 经 验 ; 第 7 章 介绍 几 项 四 旋 收 飞行 器 的 实际 应 用 案例 。 

本 书 的 撰写 得 到 了 上 海 大 学 无 人 机 协会 成 员 徐 晨 畅 、 钱 思 杰 、 曹 中 正 、 黄 潇 畅 、 胡 呈 
林 等 的 大 力 协助 ,对 他 们 在 本 书 编写 过 程 中 所 做 的 工作 表示 感谢 。 

由 于 编者 的 知识 水 平 有 限 , 书 中 玻 漏 之 处 在 所 难免 ,希望 广大 读者 批评 指正 。 
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"yi MIN RRE 
与 发 展现 状 


1.1 空中 机 器 人 


空中 机 器 人 (Aerial Robotics) 最 早 由 美国 乔治 亚 理工 大 学 的 Robert Michelson 提 
出 ,是 指 各 种 搭载 了 GPS、 机 载 导航 设备 .视觉 识别 设备 以 及 无 线 通信 设备 等 ,能 够 在 一 
定 的 范围 内 实现 无 人 飞行 的 旋翼 无 人 飞行 器 .无 人 飞艇 等 。 空 中 机 器 人 拓展 了 无 人 机 的 
概念 ,在 一 定 意 义 上 可 以 将 其 看 作 是 无 人 机 的 别称 。 空 中 机 器 人 以 研究 微型 无 人 飞行 器 
为 主要 目标 ,代表 了 未 来 微型 飞行 器 的 发 展 趋势 ,是 一 种 智能 微型 飞行 器 ,代表 了 飞行 器 
的 最 高 层次 。 

空中 机 器 人 曾经 有 过 多 种 称谓 .无 人 飞行 器 (Unmanned Aerial Vehicle ,UAV) 是 其 
中 的 一 种 。 自 从 1917 年 英国 研制 出 世界 上 第 一 架 无 人 飞行 器 ,无 人 飞行 器 已 经 经 历 了 
无 人 靶 机 、 预 编程 序 控制 无 人 侦察 机 、 指 令 遥 控 无 人 侦察 机 和 复合 控制 的 多 用 途 无 人 飞 
行 器 的 发 展 过 程 。 在 越南 战争 .中 东 战 争 和 科索沃 战争 中 ,无 人 飞行 器 卓有成效 地 执行 
了 多 重 军 事 任务 ,包括 照相 侦察 散发 传单 搜索 信号 情报 、 布 撤 雷 达 干 扰 稍 条 和 防空 火 
力 诱 饵 、 防 空 阵地 位 置 的 标识 .直升机 航路 侦察 ,为 武器 系统 提供 目标 定位 .目标 指示 、 目 
标 动态 监视 和 目标 毁伤 评估 的 实时 情报 。 无 人 飞行 器 以 突出 的 战绩 使 各 国 高 层 军事 首 
脑 对 它 刊 目 相 看 ,对 无 人 飞行 器 作为 军队 战斗 力 倍增 器 的 作用 与 地 位 及 其 潜在 的 军事 价 
值 形 成 了 共识 ,这 些 都 为 无 人 飞行 器 的 迅速 发 展 提供 了 强大 的 动力 。 

进入 20 世纪 90 年 代 ,冷战 结束 后 各 国 军费 削减 ,军队 裁员 ,人 迫使 军 方 努力 寻求 既 能 
完成 特定 任务 ,又 花费 较 少 的 途径 ,这 无 疑 对 无 人 飞行 器 的 发 展 提供 了 机 遇 。 从 军事 侦 
察 使 用 角度 来 看 ,无 人 侦察 机 是 侦察 卫星 和 有 人 侦察 机 的 重要 补充 和 增强 手段 , 它 与 侦 
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察 卫星 相 比 ,具有 成 本 低 、 侦 察 地 域 控制 灵活 、 地 面目 标 分 辨 率 高 等 特点 ; 与 有 人 侦察 机 
相 比 ,具有 可 昼夜 持续 侦察 的 能 力 ,不 必 考 虑 飞行 员 的 疲劳 和 伤亡 问题 。 青 加 上 20 世纪 
末 电 子 技术 和 航空 航天 技术 的 飞速 发 展 ,为 无 人 飞行 器 满足 军事 需求 在 技术 上 提供 了 
可 能 。 

以 上 因素 促使 世界 无 人 飞行 器 的 发 展 进 入 一 个 新 的 时 代 , 并 在 20 世纪 末 形 成 三 次 
发 展 的 浪潮 。 

第 一 个 浪潮 是 在 海湾 战争 之 后 师 级 战术 无 人 飞行 器 系统 的 发 展 。 代 表 性 机 型 有 : 以 
色 列 的 “侦察 兵 ”(Scout)、“ 先 锋 ”(Pioneer)、“ 搜 索 者 ”(Searcher); 美国 的 “猎人 ” 
(Hunter) “先驱 者 ”Outrider) ,法 国 的 “ 玛 尔 特 ”(Mart)“ 红 华 ”(Crecerelle) ,德国 的 “ 布 
雷 威 尔 ”(Brevel) ,加 拿 大 的 “289”(CL-289) ,英国 的 “不 死 鸟 (Phoenix) ,意大利 的 “ 米 拉 
奇 "(Mirach) ,南非 的 “探索 者 ”Seeker)、“ 秃 获 ”(Vulture) 和 俄罗斯 的 “ 熊 峰 "(Shmel) 等 。 

第 二 个 浪潮 是 自从 美国 的 “捕食 者 ”(Predator) 
( 迪 尔 下 ,图 1.1.1) 中 空 长 航 时 无 人 飞行 器 在 波 黑 和 
科索沃 战场 使 用 获得 成 功 之 后 ,促进 了 中 空 长 航 时 
无 人 飞行 器 的 研制 。 代 表 性 的 机 型 有 : 美国 的 “捕食 
3E" (Predator) GH 4K I," 4& E JE" CGlobalHawk) 
Gil Af I +), “m E" CDarkStar) Gilt A Ill — > « VA (83 
HER” Heron) “AZW” Heme) MAREKI” ”图 1.1.1 “捕食 者 "无 人 攻击 机 
(Eagle)“ 萨 若海 尔 ”(Sarohale) 等 。 

目前 ,空中 机 器 人 的 研究 大 都 是 围绕 微型 无 人 飞行 器 进行 的 ,这 是 因为 跟 其 他 无 人 
飞行 器 相 比 ,微型 无 人 飞行 器 造价 低 、 体 积 较 小 、 重 量 轻 、 飞 行 相对 灵活 、 起 落 受 限制 少 ， 
能 适应 复杂 多 变 的 环境 ,更 适合 进行 目标 识别 、 定 位 等 比赛 项 目 。 而 且 在 实际 应 用 中 ,由 
于 其 具有 高 度 的 灵活 性 和 很 强 的 适应 性 ,微型 无 人 飞行 器 在 军事 和 民用 上 有 着 广阔 的 应 
用 前 景 。 

在 军用 方面 ,微型 无 人 飞行 器 主要 用 于 低空 侦察 ,电子 干扰 等 作战 任务 。 这 样 不 仅 
可 减少 部 队 在 侦察 过 程 中 的 伤亡 ,还 可 以 大 大 提高 作战 效率 。 另 外 ,微型 无 人 飞行 器 还 
可 用 于 目标 指示 及 生化 武器 探测 等 。 在 城市 作战 中 ,微型 无 人 飞行 器 的 优势 更 为 突出 : 
能 够 在 建筑 物 群 中 以 很 慢 的 速度 飞行 ,以 便 绕 过 障碍 物 并 且 避 免 被 撞 倒 ; 可 以 飞 到 大 型 
建筑 物 上 执行 城区 侦察 任务 ; 可 以 探测 和 查找 建筑 物 内 部 的 敌对 分 子 或 者 恐怖 分 子 , 并 
且 窃 听 敌 方 作战 计划 等 。 同 时 ,微型 飞行 器 也 是 与 未 来 城市 作战 的 武器 发 展 趋势 相 吻 
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合 的 。 

在 民用 方面 ,微型 飞行 器 可 用 于 通信 中 继 、 环 境 研 究 、 自 然 灾难 的 监视 与 支援 。 微 型 
无 人 飞行 器 还 可 用 于 边境 巡逻 、 毒 品 禁 运 、 农 业 勘 测 并 在 未 来 大 型 牧场 和 城区 监视 等 方 
面具 有 广阔 的 市 场 和 应 用 前 景 。 

根据 结构 和 飞行 原理 的 不 同 , 无 人 机 分 为 两 种 c] 。 一 是 固定 翼 无 人 机 ,分 为 螺旋 
浆 式 无 人 机 和 喷气 式 无 人 机 ,其 飞行 原理 是 在 无 人 机 高 速 前 进 的 过 程 中 ,通过 机 辟 上 
下 气流 和 气压 的 不 同 ,产生 升力 ,保持 无 人 机 的 飞行 。 二 是 旋翼 无 人 机 , 旋 愤 的 数量 可 
以 有 一 个 或 多 个 ,本 课题 中 研究 的 是 四 旋翼 飞行 器 ,旋翼 无 人 机 的 原理 是 用 一 个 或 多 
个 螺旋 桨 的 高 速 转动 产生 升力 ,如 果 是 多 个 螺旋 桨 , 则 需要 通过 多 个 螺旋 桨 的 配合 保 
持平 衡 ,并 控制 无 人 机 6 个 自由 度 方向 的 运动 。 旋 翼 无 人 机 最 大 的 特点 就 是 可 以 垂直 
起 降 和 其 停 ,与 固定 沟 无 人 机 相 比 ,有 很 好 的 机 动 性 ,对 场地 要 求 也 较 小 ,可 扩展 功能 
TA du. 

四 旋翼 飞行 器 与 其 他 多 旋翼 飞行 器 相 比较 ,其 优点 在 于 ,机 架 易 于 制作 ,不 容易 损坏 
且 容 易 维修 ,单位 体积 拥有 更 大 的 动力 等 。 另 外 ,四 旋 避 无 人 机 有 能 力 在 狭窄 的 空间 内 
实现 各 种 功能 。 所 以 ,因为 其 广阔 的 发 展 前 景 , 近 年 来 ,不 仅 吸 引 了 科研 人 员 关 注 ,商品 
市 场 上 也 出 现 了 越 来 越 多 的 无 人 机 。 目 前 ,市 场 上 已 经 有 很 多 民用 的 无 人 机 产品 ,主要 
用 于 航拍 和 娱乐 方面 ,户外 手 控 飞 行 技 术 已 经 十 分 成 熟 。 


1.2 国内 外 四 旋翼 飞行 器 的 研究 现状 


四 旋翼 飞行 器 在 诞生 之 初 ,由 于 传感器 、 微 处 理 器 等 的 发 展 还 不 是 特别 成 熟 ,其 发 展 
受到 了 许多 局 限 , 也 迟 迟 不 能 进入 实用 阶段 。 世 界 上 第 一 架 四 旋翼 飞行 器 Gyroplane 
No.1( 如 图 1. 2. 1 所 示 ) 在 1907 年 成 功 升 空 , 它 是 由 法 国 Breguet 兄弟 制造 的 多 旋 愤 飞 
行 器 ,但 飞行 稳定 性 非常 差 吕 。 

1922 年 ,George de Bothezat 制作 了 “飞天 章鱼 ”( 如 图 1. 2. 2 所 示 ) ,设计 者 Bothezat 
直接 着 手 做 原始 尺寸 的 飞行 器 ,该 飞行 器 身长 、 宽 都 为 65 英尺 (ft,1lfts*0. 3048m) ,高 为 
10 英尺 ,机 重 3600 BECIb.1lbaz0. 454kg) ,使 用 了 180HP(1HP 守 745W) 的 发 动机 ,虽然 
只 能 成 功 飞 行 6 英尺 ,并 且 只 能 飞行 lmin, 但 这 无 疑 是 一 个 巨大 的 进步 。 

HER KITARE 20 世纪 50 年 代 被 应 用 于 陆军 机 构 ,开始 试验 各 种 垂直 起 飞 降落 的 方 
案 ,Curtiss-Wright VZ-7( 如 图 1. 2. 3 所 示 ) 使 用 了 杠杆 燃气 涡轮 机 来 提高 性 能 ,但 同时 也 
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图 1.2.2 “飞天 章鱼 ”实物 


增加 了 飞机 重量 ,1950 一 1960 年 期 间 实 现 了 相对 稳定 的 飞行 ,但 由 于 它 没有 达到 要 求 的 
高 度 和 速度 ,所 以 测试 试验 没有 进一步 施行 。 


图 1.2.3 Curtiss-Wright VZ-7 


在 美国 20 世纪 90 年 代 早 期 ,工程 师 Mike Dammar 自己 开发 了 电池 给 飞行 器 供电 ， 
在 其 加 入 Spectrolutions 公司 工作 之 后 将 该 飞行 器 命名 为 Draganflyer( 如 图 1. 2.4 所 
示 ), 后 来 加 拿 大 分 销 商 进行 了 销售 。2006 年 又 安装 了 稳定 的 航拍 视频 系统 , 称 为 
“RIR”. 

几 十 年 来 , 随 着 微 控 制 器 技术 的 巨大 突破 ,以 及 新 型 材料 、 微 机电 系统 (MEMS) 、 
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图 1.2.4  Draganflyer 


fA LIES CMIMUD DUR € FH iil A ERA . PUE KITAR CEDE A ATAA. pu 
MERE € £588 fk Mi J ELT HE HE fl SC M BEJE D EL BE PH ^E 48 E. ICT D c 3H 7108 . Rot s 
构 简单 .稳定 性 高 .易于 控制 .成 本 相对 较 低 ,能 实现 垂直 起 降 (VTOL) 等 特点 。 与 之 类 
[ESSE p 3 NS S KITARE. 

VC200 是 德国 E-vovo 公司 研发 的 一 款 多 旋翼 飞行 器 (如 图 1. 2. 5 所 示 ) ,主题 机 身 
采用 碳纤维 复合 型 材料 ,拥有 18 个 电机 旋翼 ,采用 6 组 电池 (每 组 为 3 台 发 动机 供电 )， 
能 维持 约 20min 的 飞行 。 


图 1.2.5 VC200 多 旋翼 飞行 器 


四 旋 避 飞 行 器 在 军事 领域 .自然 和 民用 等 领域 具有 广阔 的 应 用 前 景 ,如 灾害 搜救 、 军 
事 打 击 、 地 形 勘探 ,广告 航拍 .航模 玩具 等 。 目 前 ,亚马逊 .Google.DHL 等 公司 都 在 研发 
无 人 机 快递 业务 服务 ,其 中 亚马逊 无 人 送 货机 如 图 1.2.6 所 示 。 其 飞行 器 也 是 运用 了 多 
旋涡 飞行 器 ,相信 不 和 久 的 将 来 ,将 不 用 快递 员 进 行 送 货 ,这 将 大 大 减少 人 力 投资 ,并 在 很 
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大 程度 上 改善 人 们 的 生活 。 


图 1.2.6 亚马逊 无 人 送 货机 


四 旋 融 飞行 器 的 应 用 还 进入 了 和 餐饮 行业 ,和 餐厅 用 飞行 器 为 用 户 送 上 热 腾腾 的 餐 食 。 
英国 达 美 乐 分 公司 通过 跟 创 意 公司 合作 开发 了 一 架 名 为 “ 达 美 乐 直 升 机 ”的 送 餐 飞行 器 。 
CHEE 10min 之 内 将 食物 送 到 4 英里 (1 RES], 61km) 之 外 , 极 大 地 提高 了 送 餐 效率 。 
同样 地 ,一 家 名 为 Yo! Sushi 寿司 ”的 餐馆 也 提出 了 用 飞行 器 进行 送 餐 的 全 新 方式 一 一 
服务 员 通 过 控制 iPad 来 操控 四 旋翼 飞行 器 ,将 承载 食物 的 餐 盘 送 到 顾客 的 餐桌 上 (如 
图 1.2.7 所 示 )。 


图 1.2.7 利用 四 旋翼 飞行 器 进行 送 餐 


因此 ,由 于 四 旋 深 飞行 器 所 具备 的 以 上 特点 及 其 广阔 的 应 用 前 景 ,人 们 对 研究 四 旋 
辟 飞 行 器 的 热情 被 重新 点 燃 了 。 


1.2.1 国外 研究 现状 


国外 许多 大 学 和 商业 公司 在 近 十 几 年 间 对 四 旋 辟 飞行 器 进行 了 研究 和 探索 。 下 面 
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将 对 他 们 的 工作 加 以 介绍 。 

自 2002 年 开始 ,宾夕法尼亚 大 学 (UPenn) 提 出 了 基于 视觉 反馈 的 直升机 控制 系统 。 
研究 人 员 通 过 使 用 HMX-4 这 一 商业 模型 开发 了 自己 的 四 旋 愤 飞行 器 (如 图 1. 2. 8 所 
示 )。 其 飞行 器 控制 系统 是 通过 系统 中 微 控制 器 和 远程 遥控 来 实现 的 ,远程 PC 首先 对 传 
感 器 传输 的 数据 进行 分 析 处 理 , 然 后 回 送 控制 信息 。 其 四 轴 控 制 系统 中 携带 3 种 传感器 
模块 ,用 于 实现 闭环 的 增 稳 控 制 。 同 时 整套 系统 中 ,地 面 安放 了 用 于 主 监控 的 摄像 机 ,并 
在 飞行 器 底部 设计 了 彩色 符号 来 为 摄像 机 定位 ,利用 这 些 符 号 计算 出 飞行 器 的 相对 位 
移 , 地 面 PC 即 可 算出 四 旋 辟 飞行 器 的 空间 旋转 角度 和 水 平 位 移 。 这 一 团队 的 研究 成 果 
也 多 次 出 现在 TED 演讲 、 优 酷 视频 等 中 ,自主 悬 停 时 使 用 基于 模型 的 线性 反馈 控制 ,而 
在 穿越 障碍 .自主 飞行 时 与 视觉 反馈 控制 相 结合 ,其 研究 重点 已 经 向 多 机 协作 和 自主 飞 
行 倾斜 。 


图 1.2.8 宾夕法尼亚 大 学 Kumar Lab iiit ff) uj € (7 28 


Mesicopter( 如 图 1. 2. 9 所 示 ) 是 斯 坦 福 大 学 (Stanford) 的 研究 小 组 在 NASA 支持 
下 ,为 研究 微型 旋 沟 飞行 器 技术 而 设计 的 试验 装置 中。 机 身 为 16mm X 16mm 的 方形 框 
架 ; 旋翼 直径 为 1. 5cm, 厚 度 为 0.08mm; 电机 直径 为 3mm ,质量 为 325mg。 Mesicopter 
飞行 器 研究 组 设计 了 应 用 于 自主 飞行 器 控制 研究 (STARMAC) 的 测试 平台 ,其 控制 系统 
包含 : 惯性 测量 单元 (IMU) 、 微 控制 器 、 超 声波 测 距 传感器 、GPS 定位 导航 单元 以 及 蓝牙 
通信 模块 ,主要 实现 了 姿态 估 测 和 数据 通信 ; 在 控制 端 则 设计 了 PC 和 遥控 器 操作 装置 。 
惯性 测量 单元 从 传感器 中 获得 姿态 数据 后 估 测 出 当前 飞行 器 的 高 度 及 其 运动 速度 ,然后 
输出 这 两 组 数据 ,由 于 飞行 器 在 升力 变化 时 会 产生 较 大 震动 ,因此 两 组 数据 混 有 较 大 的 
噪声 ,导致 估 测 准确 性 降低 ; 同时 超声 波 传感器 的 数据 也 不 可 靠 , 所 以 需要 卡尔 曼 滤 波 器 
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首先 去 噪 ,再 进行 高 度 估 测 。 系 统 中 还 加 入 了 红外 传感器 来 协助 完成 飞行 器 的 距离 测量 
任务 。 系 统 中 还 设计 了 另 一 个 卡尔 曼 滤波 器 用 来 将 计算 出 的 GPS 数据 .速度 数据 以 及 高 
度 信 息 融 合 在 一 起 ,计算 出 飞行 器 的 位 置 和 速度 信息 。 


图 1.2.9 斯 坦 福 大 学 的 Mesicopter 


瑞士 洛桑 联邦 理工 学 院 于 2003 年 开始 研发 了 OS4 微型 四 旋 必 飞行 器 (如 图 1. 2. 10 
所 示 ) ,试验 了 各 种 不 同 的 控制 算法 ,对 于 最 优 控制 理论 .飞行 器 自主 飞行 和 避 障 等 做 了 
比较 深入 的 研究 。OS4 是 EPFL 自动 化 系统 实验 室 开发 的 一 种 电动 小 型 四 旋 必 飞行 器 ， 
其 研究 的 重点 是 机 构 设计 方法 和 自主 飞行 控制 算法 ,目标 是 要 实现 室内 和 室外 环境 中 的 
完全 自主 飞行 。 

目前 ,该 项 目 已 经 进行 了 两 个 阶段 。OS4 工 最 大 长 度 约 73cm, 质 量 为 235g; 它 使 用 
了 Draganflyer 的 旋翼 和 十 字 框 架 ,4 个 Faulhaber 1724 电机 ,以 及 一 个 Xsense 的 MT9- 
B 微 惯性 测量 单元 。 至 2004 年 ,OS4 工 已 经 分 别 基于 多 种 控制 算法 (如 PID, LQ, 
Backstepping,Sliding-mode) ,实现 了 飞行 器 姿态 控制 。OS4 下 的 机 身 最 大 长 度 为 72cm， 
重 为 520g; 机 载 230g 的 锂电 池 ,提供 自主 飞行 30min 的 能 量 。 它 与 OS4 工 的 区 别 主 要 
有 : 使 用 了 桨 叶 面 积 更 大 的 新 旋 辟 ; 使 用 了 更 轻 、 功 率 更 大 的 LRK 无 刷 电机 BLDC; 使 
用 皮带 减速 装置 代替 了 电机 减速 箱 ; 控制 器 ,传感器 .电池 和 电机 驱动 模块 等 都 直接 安装 
在 机 体 上 ,不 再 由 机 体外 部 提供 。 

此 外 麻 省 理工 学 院 的 Robust Robtics 和 佐治 亚 理工 大 学 的 GTMARS 等 研究 组 也 都 
对 四 旋 细 飞行 器 的 建 模 、 飞 行 ,视觉 控制 .周围 环 境 监 测 等 做 了 很 多 研究 工作 。 
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图 1.2.10 洛桑 联邦 理工 学 院 开 发 的 OS4 T ( 左 ) 和 OS4 TIL CAD 


在 商业 领域 ,法 国 巴黎 的 Parrot 公司 在 2010 年 的 国际 消费 类 电子 产品 展览 会 
(Consumer Electronics Show) 上 展示 了 一 款 名 为 AR. Drone 的 双 摄 像 头 航模 玩具 (如 
图 1.2.11 所 示 ), 以 其 创新 的 玩法 获得 了 2010 年 国际 消费 电子 展 电子 游戏 硬件 创新 奖 。 
AR. Drone 类 似 于 一 款 无 人 驾驶 直升机 ,拥有 4 个 独立 螺旋 桨 ,用 户 可 以 使 用 iPhone, 
iPod Touch 对 其 进行 飞行 控制 操作 ,能够 实现 自动 悬浮 定位 .自动 导航 驾驶 .手机 无 线 遥 
控 \ 高 清 实时 航拍 等 有 趣 而 复杂 的 功能 。 


Parrot 


FIF.) Eran 


EXCLUSIVE! "Pre Order Today" 


B 1.2.11 AR. Drone 四 轴 玩 具 飞 机 


拉脱维亚 直 升 宇航 工业 公司 (Helico Aerospace Industies) 所 设计 的 AirDog 飞行 器 
(如 图 1. 2. 12 所 示 ) 是 一 款 专 为 极限 运动 所 打造 的 跟 拍 器 。AirDog 是 一 款 专 有 航拍 器 ， 
支持 索尼 以 及 GoPro 摄像 机 , 折 生 起 来 小 到 可 以 放 进 背包 ,其 最 独特 的 地 方 是 可 实现 全 
自动 。AirDog 还 配置 了 一 个 名 为 AirLeash 的 腕 带 控制 器 ,用 户 只 须 将 其 绑 在 手臂 上 就 
能 操作 控制 AirDog 的 起 飞 和 降落 ,在 行动 过 程 中 ,AirDog 还 利用 了 回转 仪 稳定 技术 确 
保 被 拍摄 物体 始终 能 在 拍摄 画面 里 。 该 设备 可 以 预先 设 定 飞行 模式 ,这 样 就 能 确保 在 不 
同 的 体育 运动 中 拍摄 到 最 佳 效果 的 影片 ,这 些 体育 运动 包括 极限 脚 踏 越野 车 (BMX)、 极 
限 滑 雪 、 冲 浪 .越野 摩托 车 ` 水 上 滑板 等 ,可 以 通过 手机 APP 进行 设 定 。 
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四 旋涡 飞行 器 在 其 他 领域 的 潜力 也 不 断 被 挖掘 出 来 。 苏 黎 世 联邦 理工 学 院 (ETH) 
的 法 比 奥 格 。 拉 马里 奥 与 马 提 亚 斯 。 科 幸 勒 教授 运用 数控 加 工 技术 控制 的 四 旋翼 飞行 
器 操控 传统 的 砖 块 堆砌 起 一 座高 6m、 直 径 3. 5m 的 1 : 100 的 名 为 “垂直 村 落 ” 的 建筑 模 
型 (如 图 1. 2. 13 所 示 ) ,模型 本 身 的 建造 方法 也 正 是 类 比 着 设计 中 垂直 向 上 “生长 ”的 高 
层 “ 村 落 ”。 整 个 过 程 完全 由 多 架 四 旋 淆 飞行 器 独立 完成 ,使 用 了 超过 1500 JURE Cs 
泡沫 制作 的 砖 块 , 几 架 四 轴 直 升 机 像 蜜蜂 一 样 回 旋 飞 舞 , 抓 起 一 块 块 砖头 ,精准 定位 后 将 
砖头 一 块 块 放下 , 层 层 全 全 地 砌 出 一 个 曲线 形状 的 大 尺度 构筑 物 。 


AirDog 


多 


图 1.2.12 AirDog 图 1.2.13 四 旋翼 飞行 器 堆砌 出 来 的 建筑 模型 


四 旋涡 飞行 器 的 主要 优点 如 下 。 

CD 拥有 简单 的 机 械 结构 ,没有 传统 直升机 复杂 的 旋翼 控制 机 构 。 

@ 拥有 稳定 的 飞行 姿态 。 飞 行 器 控制 系统 通过 传感器 采集 飞行 姿态 数据 ,实时 监测 
和 控制 飞行 姿态 ,可 以 实现 飞行 器 保持 平稳 的 飞行 。 与 传统 单 旋 滤 直 升 飞机 相 比 ,四 旋 
辟 飞 行 器 的 飞行 更 为 稳定 。 

@ 容易 将 体积 做 得 很 小 ,可 以 实现 自主 飞行 器 的 小 型 化 和 微型 化 。 微 型 四 轴 器 调试 
相对 容易 简单 ,而 制作 完成 之 后 ,执行 任务 的 地 点 也 更 加 多 样 化 。 

@ 飞 行 器 拥有 4 个 电机 ,具有 更 大 的 载重 力 。 
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此 外 ,四 旋 辟 飞行 器 还 具有 成 本 低 、 噪 声 小 的 优点 , 比 单 层 直升机 或 者 其 他 垂直 起 降 
机 其 更 易于 维护 。 因 此 ,旋翼 无 人 机 广泛 应 用 于 民用 和 军事 领域 ,如 救援 .侦察 、 勘 探 等 
方面 。 


1.2.2 国内 研究 现状 


国内 对 于 四 旋 沟 飞行 器 的 研究 起 步 较 晚 ,但 是 发 展 迅 速 ,最 早 的 研究 开始 于 2000 年 
左右 。 

2001 年 ,上 海 大 学 通过 利用 已 有 的 相关 技术 ,初步 研究 和 设计 四 旋 辟 飞行 器 飞行 控 
制 ,并 实现 飞行 试验 。 重 点 对 整个 飞行 器 做 了 样机 设计 ,包括 控制 算法 设计 、 控 制 系统 软 
件 设 计 和 硬件 设计 。 为 实现 自主 控制 英 定 了 基础 。 

国防 科技 大 学 在 2004 年 开始 研究 微型 四 旋 渐 飞行 器 ,做 了 一 系列 的 建 模 和 实践 ,并 
在 2006 年 完成 了 对 四 旋翼 飞行 器 的 原型 样机 的 设计 ,根据 Quad-Rotor 飞行 原理 和 牛 
顿 一 欧 拉 方程 建立 了 四 旋翼 飞行 器 的 动力 学 模型 ,设计 了 基于 模糊 滑 模 控制 理论 的 姿态 
控制 算法 ,并 且 通 过 试验 仿真 验证 了 四 旋 愤 飞行 器 姿态 控制 算法 的 有 效 性 ,实现 了 基于 
Quad-Rotor 的 姿态 增 稳 控制 。 

随后 ,哈尔滨 工业 大 学 建立 了 四 旋翼 飞行 器 的 动力 学 模型 和 运动 学 模型 ,并 针对 四 
旋 泌 飞行 器 系统 的 线性 模型 的 不 确定 性 ,基于 回路 成 形 法 设计 实现 了 鲁 棒 控制 器 ,并 基 
于 四 旋 愤 飞行 器 的 非 线 性 模型 进行 了 仿真 分 析 和 研究 ,取得 了 比较 好 的 控制 效果 。 

此 外 ,南京 航空 航天 大 学 ,西北 工业 大 学 等 高 校 也 相继 进行 了 较 多 的 试验 和 探索 , 广 
东 的 模型 厂商 也 推出 了 多 款 小 型 四 旋 避 飞行 器 。 但 四 旋 必 飞行 器 要 走向 成 熟 和 实用 ,还 
面临 着 诸多 关键 技术 的 挑战 。 

除了 各 大 高 校 的 研究 攻关 ,多 旋翼 飞行 器 各 方面 技术 的 进步 和 成 熟 也 离 不 开 诸 多 消 
费 级 无 人 机 公司 的 推动 ,而 以 大 疆 创 新 科技 有 限 公司 为 首 的 各 个 创业 公司 则 成 为 了 行业 
的 引领 者 。 

深圳 市 大 疆 创 新 科技 有 限 公 司 (DJD 成 立 于 2006 年 ,是 全 球 领先 的 无 人 飞行 器 控制 
系统 及 无 人 机 解决 方案 的 研发 和 生产 商 ,客户 遍布 全 球 100 多 个 国家 。 大 疆 公 司 致力 于 
通过 持续 的 创新 为 无 人 机 工业 行业 用 户 以 及 专业 航拍 应 用 提供 性 能 最 强 、 体 验 最 佳 的 
革命 性 智能 飞行 控制 产品 和 解决 方案 。 

2013 年 1 月 ,大 疆 公 司 发 布 “ 精 灵 ”( 如 图 1. 2. 14 所 示 ) ,这 一 产品 一 举 援 动 了 非 专业 
无 人 机 市 场 ,使 得 大 疆 公 司 在 市 场 上 站 稳 脚 跟 ,为 大 驻 公 司 成 为 这 一 行业 引领 者 打下 了 
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坚实 的 基础 。 现 在 大 疆 公 司 已 经 形成 了 完整 的 产品 线 , 除 “精灵 ”系列 外 ,大 疆 还 将 2014 
年 11 月 面世 的 InSPIre( 悟 )( 如 图 1.2.15 所 示 ) 系 列 定位 为 “一体 化 空中 影像 系统 ”, 此 系 
列 的 目标 群体 是 高 端 电 影 ,视频 创作 者 ; 筋 斗 云 系 列 飞 行 平 台 是 为 资深 航拍 爱好 者 开发 
的 一 系列 专业 级 载 机 ,具有 便携 易 用 、 安 全 稳定 等 特点 ,主要 应 用 于 专业 航拍 领域 ， MG- 
1S 农业 植保 机 集成 大 疆 最 新 技术 ,可 实现 作业 规划 、 飞 行 实时 管理 和 工作 统计 ,不 仅 是 一 
款 高 性 能 无 人 机 ,还 为 消费 者 提供 了 一 整套 智能 便捷 的 农业 植保 解决 方案 ; Mavic 主打 
小 体积 、 远 距离 图 传 和 长 时 间 续 航 ,巧妙 的 折 释 设计 让 消费 者 能 轻装 上 阵 , 尽 情 享 受 飞行 
与 拍摄 的 乐趣 。 


epa "Q5 


图 1.2.14 大 疆 “ 精 灵 ” 系 列 无 人 机 图 1.2.15 Xl InSPIre( 悟 ) 系 列 无 人 机 


ev 


PowerEgg 无 人 机 (如 图 1. 2. 16 和 图 1.2. 17 所 示 ) 是 至 迪 推出 的 首 款 消费 级 无 人 
机 ,此 项 目 于 2014 年 6 月 立项 ,2016 年 8 月 进行 京东 众 筹 ,受到 广泛 关注 ,并 在 短 时 间 内 
众 筹 成 功 。 通 过 这 款 融 合 了 科技 与 艺术 的 飞行 机 器 人 ,至 迪 希 望 能 让 更 多 的 人 体验 到 航 
拍 飞 行 的 乐趣 ,所 以 PowerEgg 通过 技术 创新 和 设计 创新 ,主打 易 用 人 性、 便携 性 及 安全 性 
等 诸多 功能 ,希望 帮助 用 户 解 决 痛 点 。 这 款 无 人 机 最 大 的 特点 就 是 外 形 被 设计 成 了 蛋 
形 , 机 臂 可 以 完全 折 番 ,一体 化 的 造型 十 分 方便 用 户 携 带 ; 而 从 操控 上 S a AR T E 
业 的 航拍 手 、 摄 影 爱好 者 和 一 些 航模 爱好 者 之 外 ,能 有 更 多 对 无 人 机 感 兴趣 的 小 白 用 户 
也 可 以 享受 到 飞行 的 乐趣 。 因 此 ,PowerEgg 除了 标准 版 的 遥控 器 之 外 ,还 特别 推出 了 体 
感 遥控 器 ,通过 体感 遥控 器 可 以 实现 一 键 甚 停 ,一 键 拍照 ,一 键 跟踪 环绕 等 功能 ,简单 易 
上 手 , 甚 至 连 小 孩 也 能 操作 。 

2016 年 4 月 27 日 ，ZeroRobotics 公司 正式 发 布 Hover Camera( 如 图 1. 2. 18 和 
图 1. 2. 19 所 示 ) ,这 是 全 球 首部 真正 意义 上 的 安全 、 易 用 、 便 携 式 跟 拍 无 人 机 ,这 款 无 人 
机 的 质量 只 有 238g, 却 拥有 1300 万 像素 摄像 头 , 可 以 拍摄 AK 视频 ,同时 还 可 以 提供 720 
像素 高 清 实 时 数据 流 ,这 些 数据 流 可 以 通过 WiFi 传 到 智能 手机 。 这 款 无 人 机 的 特别 之 
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图 1.2.16 PowerEgg ŽANA A 图 1.2.17 PowerEgg 无 人 机 展开 图 


处 在 于 其 可 以 悬 停 在 空中 完成 这 些 任务 ,用 户 可 以 通过 智能 手机 指挥 其 行动 。Hover 
Camera 也 支持 甚 停 旋 转 全 景 拍摄 。 它 采用 碳纤维 外 壳 以 及 创新 性 的 可 折 秋 式 设计 ,大 
大 增强 了 产品 的 安全 性 和 便携 性 。 无 须 费力 学 习 或 组 装 ,只 要 展开 机 愤 并 开机 , Hover 
Camera 便 会 从 用 户 的 指 尖 稳 稳 起 飞 , 以 独特 视角 拍摄 视频 或 照片 。 这 款 产品 主打 便携 ， 
折 全 后 的 收纳 尺寸 为 18cemX13cm, 同 时 具备 体感 操控 、 自 动 跟随 、 指 尖 放 飞 和 空中 摘 取 


HOVER 


CAMERA 
Passport 


图 1.2.18 Hover Camera JE A BLUT F 图 1.2.19 Hover Camera 无 人 机 展开 图 


除了 这 些 明星 产品 , 近 10 年 来 ,国内 同样 涌现 出 了 一 批 拥 有 自己 核心 技术 的 无 人 机 
公司 ,如 亿 航 、 零 度 、 极 飞 和 易 瓦特 等 。 

2007 年 成 立 的 极 飞 是 我 国 最 早 开 始 研 发 多 旋 愤 无 人 机 的 公司 之 一 ,如 今 也 是 着 重 农 
业 领 域 的 无 人 机 公司 之 一 。 该 公司 研制 的 “ 农 飞 P20 植保 无 人 机 系统 (XPlanet)”( 如 
图 1. 2. 20 所 示 ) 帮 助 新 疆 棉 农 喷洒 农药 ,将 无 人 机 真正 应 用 到 实处 。 同 时 , 极 飞 无 人 机 
还 与 物流 公司 友好 合作 ,举办 了 比 动 一 时 的 淘宝 无 人 机 送 货 服务 。 

虽然 零度 智 控 公司 成 立 于 2007 年 ,但 是 2011 年 才 开 始 研制 多 旋翼 无 人 机 ,2015 年 
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图 1.2.20 极 飞 植保 无 人 机 


设计 消费 级 无 人 机 。 第 一 款 消费 级 无 人 机 产品 一 一 Xplorer 标准 版 (如 图 1. 2. 21 所 示 ) 
售 价 仅 2499 元 ,让 拥有 炫 酷 的 四 旋 导 飞 行 器 不 再 是 梦想 ,因此 也 被 称 为 “价格 屠夫 ”。 该 
公司 无 人 机 主要 应 用 于 航拍 领域 ,在 ( 智 取 威 虎 山 》 和 《天 河 ) 等 电影 中 均 有 应 用 ,如 今 已 
经 占据 1/3 的 航拍 市 场 。 

亿 航 科技 于 2014 年 在 广州 成 立 , 可 以 说 是 无 人 机 行业 的 新 生 力 量 ,其 实力 不 容 小 
上 凯 。 旗 下 第 一 款 无 人 机 Ghost( 如 图 1. 2. 22 所 示 ) 仅 需要 一 款 手机 APP 就 可 轻松 实现 起 
飞 , 返 航 、 下 降 等 一 系列 操作 。 该 无 人 机 以 80 万 美元 的 成 绩 创 下 了 中 国 海外 众 筹 项 目的 
新 纪录 。 如 今 有 报道 称 一 家 名 为 Lung Biotechnology 的 生物 科学 公司 计划 与 亿 航 科技 
合作 ,利用 无 人 机 运送 移植 器 官 ,虽然 有 些 不 可 思议 ,但 是 也 肯定 了 亿 航 无 人 机 的 发 展 与 
努力 。 


PTEIN 


Æ 1.2.21 零度 Xplorer 无 人 机 图 1.2.22 亿 航 Ghost 无 人 机 
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1.3 MRR KITARAA 


1.3.1. 总 体 设计 优化 


进行 微小 型 四 旋 波 飞行 器 总 体 设 计时 ,需要 遵循 以 下 原则 : 质量 轻 . 尺 寸 小 .速度 快 、 
能 耗 和 成 本 低 。 但 这 几 项 原则 相互 之 间 存 在 着 制约 与 矛盾 ,因此 进行 四 旋翼 飞行 器 总 体 
设计 时 ,首先 要 根据 性 能 和 价格 选择 合适 的 机 架 材料 , 尽 可 能 地 减轻 飞行 器 质量 ; 其 次 要 
综合 考虑 质量 、 尺 寸 、 飞 行 速度 和 能 耗 等 因素 ,确保 实现 总 体 设计 的 最 优化 。 


1.3.2 能 源 动力 系统 


动力 装置 包括 旋 愤 微型 直流 电机 、 电 调 等 ,能 量 由 机 载 电池 提供 。 四 旋 尼 飞 行 器 的 
质量 是 影响 其 尺寸 的 主要 因素 ,而 动力 与 能 源 装置 的 质量 在 整个 机 体质 量 中 占 了 很 大 比 
例 。 对 于 OSA ,该 比例 就 高 达 75%。 因 此 ,研制 更 轻 、 更 高 效 的 动力 与 能 源 装 置 是 进 一 
步 微小 型 化 四 旋 愤 飞行 器 的 关键 。 另 外 ,动力 装置 产生 升力 时 消耗 了 绝 大 部 分 机 载 能 
量 。 例 如 ,OS4 下 的 电能 有 91% 被 动力 装置 消耗 。 要 提高 飞行 器 的 效率 ,关键 在 于 提高 
动力 装置 的 效率 。 除 尽量 提高 机 械 传 动 效 率 外 ,还 必须 选择 合适 的 电机 与 减速 比 ,在 兼 
顾 最 大 效率 和 最 大 输出 功率 两 项 指标 的 前 提 下 ,将 电机 工作 点 配置 在 推荐 运行 区 域内 。 


1.3.3 建立 数学 模型 


为 实现 对 微小 再 四 旋翼 飞行 器 的 有 效 控制 ,必须 准确 建立 其 在 各 种 飞行 状态 下 的 数 
学 模型 。 但 在 飞行 过 程 中 , 它 不 仅 同时 受到 多 种 物理 效应 的 作用 (空气 动力 .重力 、 陀 螺 
效应 和 旋翼 惯量 矩 等 ) ,还 很 容易 受到 气流 等 外 部 环境 的 干扰 。 因 此 ,很 难 建立 有 效 、 可 
靠 的 动力 学 模型 。 此 外 ,所 使 用 的 旋 导 尺寸 小 .质量 轻 、 易 变形 ,很 难 获得 准确 的 气动 性 
能 参数 ,也 将 直接 影响 模型 的 准确 性 。 

建立 四 旋翼 MAV 数学 模型 时 ,还 必须 深入 研究 和 解决 低 雷 诺 数 条 件 下 旋 浊 空气 动 
力学 问题 。 微 型 飞行 器 空气 动力 学 特性 与 常规 飞行 器 有 很 大 的 不 同 ,当前 许多 空气 动力 
学 理论 和 分 析 工具 均 不 适用 ,需要 发 展 新 的 理论 和 研究 手段 。 
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1.3.4 飞行 控制 


四 旋 引 飞 行 器 是 一 个 具有 六 自由 度 ( 位 置 与 姿态 ) 和 4 个 控制 输入 ( 旋 避 转速 ) 的 欠 
驱动 系统 (Underactuated System) ,具有 多 变量 , 非 线 性 、 强 耦合 和 干扰 敏感 的 特性 ,使 
得 四 旋 愤 飞行 器 的 设计 变 得 非常 困难 。 此 外 ,控制 器 性 能 还 将 受到 模型 准确 性 和 传感器 
精度 的 影响 。 姿 态 控制 是 整个 飞行 控制 的 关键 ,因为 四 旋 副 飞行 器 的 姿态 与 位 置 存在 直 
接 耦 合 关系 (俯仰 、 横 滚 直 接 引 起 机 体 向 前 后 左右 移动 ) ,如果 能 精确 控制 飞行 器 姿态 ， 
则 采用 PID 控制 律 就 足以 实现 其 位 置 与 速度 控制 。 国 际 相关 研究 都 着 重 进行 了 姿态 控 
制 器 的 设计 与 验证 ,结果 表明 ,尽管 采用 非 线性 控制 律 能 够 获得 很 好 的 仿真 效果 ,但 由 于 
对 模型 准确 性 有 很 强 的 依赖 ,其 实际 控制 效果 反而 不 如 PID。 因 此 ,研制 既 能 精确 控制 飞 
行 器 姿态 ,又 具有 较 强 抗 干扰 和 环境 自 适应 能 力 的 姿态 控制 器 是 四 旋翼 飞行 器 研究 的 
关键 。 


1.3.5 定位 .导航 与 通信 


微小 型 四 旋 深 飞行 器 主要 面向 近 地 面 环境 ,如 城区 、 森 林 、 隧 道 和 室内 等 。 但 是 , 目 
前 还 存在 定位 .导航 与 通信 方面 的 问题 。 一 方面 ,在 近 地 面 环境 中 ,GPS 常常 不 能 正常 工 
作 ,需要 综合 惯 导 、 光 学 声学 .雷达 和 地 形 匹 配 等 技术 ,开发 可 靠 、 精 确 的 定位 与 导航 技 
术 ; 另 一 方面 , 近 地 面 环境 地 形 复杂 ,干扰 源 多 ,当前 通信 链 技术 的 可 靠 性 .安全 性 和 抗 干 
扰 性 还 不 能 满足 实际 应 用 的 需求 。 因 此 ,研制 体积 小 质量 轻 \ 功 耗 低 ,稳定 可 靠 和 抗 干 
扰 的 通信 链 对 微小 型 四 旋翼 飞行 器 技术 (尤其 是 多 飞行 器 协同 控制 技术 ) 的 发 展 而 言 是 
十 分 关键 的 。 


Mie KITA KITE 


2.1 基本 原理 


四 旋 深 飞行 器 通过 改变 自身 4 个 旋翼 的 转速 ,可 以 比较 灵活 地 进行 各 种 飞行 动作 。 
其 主要 依据 的 运动 原理 是 力 的 合成 与 分 解 , 以 及 空气 转动 扭矩 的 反 向 性 。 四 旋翼 飞行 器 
通常 有 两 种 模式 , 即 “ 十 "字形 模式 与 X 形 模式 。 

需要 注意 的 是 , 相 邻 的 两 个 旋翼 的 转动 方向 相反 ,而 在 对 角 线 上 的 两 个 电机 的 转动 
方向 相同 。 例 如 ,图 2.1.1 中 的 X 形 模式 ,1.4 电 机 是 顺 时 针 方向 转动 ,而 2.3 电机 是 逆 
时 针 方向 转动 。 这 样 一 来 ,为 了 保证 它们 产生 的 升力 都 是 向 上 的 ,1、4 电机 需要 使 用 的 螺 
旋 桨 是 “ 正 桨 ”, 一 般 指 顺 时 针 方 向 转动 能 产生 向 上 升力 的 桨 ; 而 2、3 电机 使 用 的 螺旋 桨 
是 “ 反 浆 ”, 即 送 时 针 方 向 产生 向 上 升力 的 桨 。 在 装配 四 轴 时 ,也 应 注意 4 个 旋 导 都 是 “向 
下 吹风 ”的 ,以 便 均 提供 向 上 的 拉力 。 


图 2.1.1 X 形 模式 与 “十 ”字形 模式 
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这 样 做 的 原因 是 旋光 在 旋转 时 会 产生 反 扭矩 。 例 如 , 顺 时 针 方向 转动 的 桨 在 转动 
时 ,空气 会 产生 使 得 四 轴 逆 时 针 方向 转动 的 反 向 扭矩 。 而 当 1、4 同方 向 ,2、3 同方 向 的 时 
候 ,这 两 个 扭矩 就 恰好 抵消 掉 , 使 得 四 轴 在 偏 航 方向 能 保持 平衡 ,不 至 于 出 现 自 旋转 。 

四 旋涡 飞行 器 可 以 分 别 沿 着 机 体 的 X.Y、Z 三 个 轴 进行 旋转 或 者 平移 运动 ,因此 在 
每 个 轴 向 上 有 两 个 自由 度 。 四 旋翼 飞行 器 有 6 种 基本 飞行 动作 。 

1. 升降 运动 

升降 运动 (如 图 2. 1.2 所 示 ) 实 际 上 就 是 飞行 器 在 Z 轴 方向 的 上 下 运动 。 假 设 四 旋 
翼 飞 行 器 处 于 平稳 状态 ,4 个 旋翼 转速 完全 一 样 。 此 时 同时 使 4 个 旋翼 转速 增加 ,可 以 让 
升力 克服 机 体重 量 ,使 得 机 体 垂 直 向 上 运动 ; 反之 ,同时 减 小 4 个 旋翼 的 转速 ,可 使 机 体 
垂直 下 降 。 当 4 个 旋 没 处 于 某 一 转速 时 ,升力 和 机 体重 力 相等 ,此 时 飞行 器 处 于 平稳 悬 
停 的 状态 。 


图 2.1.2 升降 运动 


2. 俯仰 运动 

假设 以 X 轴 正 方向 为 飞行 器 前 进 方向 (电机 0 为 前 方 ) ,俯仰 运动 是 飞行 器 以 机 体 坐 
dk Y 轴 为 中 心 轴 的 一 个 转动 。 如 图 2. 1. 3 所 示 ,以 仰 动作 为 例 ,在 保持 电机 1、3 转速 不 
变 的 同时 ,电机 0 的 转速 增加 使 升力 加 大 ,电机 2 的 转速 减 小 使 升力 降低 。 飞 行 器 会 以 
机 体 Y 轴 (电机 1、3 所 在 轴 ) 为 转轴 产生 一 个 转动 ,电机 0 上升, 而 电机 2 下降 ,这 就 是 飞 
行 器 的 仰 动作 ; 反之 ,保持 电机 1、 电 机 3 的 升力 不 变 , 让 电机 2 转速 增加 ,电机 0 转速 减 
小 ,将 实现 飞行 器 俯 的 动作 。 俯 仰 动作 需要 通过 控制 飞行 器 前 后 方向 上 的 两 个 电机 的 速 
率 来 实现 。 俯 仰 动作 实质 上 还 会 影响 飞行 器 的 前 进 和 后 退 动作 。 

3. 横 滚 运动 

横 滚 运动 与 俯仰 动作 原理 相同 ,如 图 2. 1. 4 所 示 ,保持 电机 0 和 电机 2 的 转速 不 变 ， 
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图 2.1.3 俯仰 运动 


分 别 改变 电机 1,3 的 转速 ,可 使 机 身 以 机 体 坐 标的 X 轴 为 旋转 轴 旋 转 。 横 滚动 作 实质 上 
还 会 影响 飞行 器 的 左 移 和 右 移 动作 。 


po 
图 2.1.4 BRZ 

4. 偏 航运 动 ( 自 旋 ) 

偏 航 (转向 ?运动 实际 上 是 机 体 绕 自身 坐标 Z 轴 的 一 个 自 旋 转 的 过 程 。 从 单个 旋光 
来 看 ,旋转 中 的 旋翼 会 对 机 体 有 一 个 反 扭 矩 。 如 果 飞 行 器 为 单 旋涡 ,在 旋 必 转动 时 ,机 身 
会 朝 反方 向 旋转 。 因 此 ,多 轴 飞 行 器 的 旋 导 均 为 偶数 个 ,而 且 正 反 转 各 一 半 。 这 样 在 飞 
行 中 , 正 反 转 旋 姻 的 反 扭 矩 会 相互 抵消 。 四 旋 辟 飞行 器 的 偏 航运 动 实质 上 是 通过 4 个 旋 
翼 转 速 不 同 而 使 得 扭矩 不 平衡 的 结果 ,就 是 使 得 机 身 绕 机 体 坐标 Z 轴 旋 转 。 如 图 2.1.5 
所 示 , 当 电机 0 和 电机 2 转速 上 升 , 同 时 电机 1 和 电机 3 转速 下 降 ,电机 0.2 的 反 扭 矩 大 
于 电机 1,3 的 反 扭 矩 ,机 身 会 以 机 体 Z 轴 为 转轴 以 电机 0、2 旋转 方向 的 反方 向 旋转 ; 反 
之 , 当 电机 1、3 的 转速 上 升 ,电机 0、2 的 转速 下 降 时 ,机 身 会 朝 与 电机 1,3 转动 相反 的 方 
向 旋转 。 
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图 2.1.5 偏 航 运动 


2.2 四 旋翼 飞行 器 姿态 表示 


2.2.1 坐标 系统 建立 


为 了 获得 四 旋 愤 飞行 器 控制 系统 的 数学 模型 ,首先 建立 两 个 基本 坐标 系 , 即 惯性 坐 
标 系 E(Oxyz ) 和 飞行 器 坐标 系 B(Oxyz ) ,如 图 2. 2. 1 所 示 。 通 常 在 大 地 上 要 建立 一 个 全 
局 坐标 系 (Global Coordinate System. GCS) ,用 来 对 整个 多 体系 统 提供 一 个 统一 的 参照 
坐标 系 。 在 物体 上 要 建立 一 个 局 部 坐标 系 , 称 为 BCS(Body Coordinate System) ,一 方面 
用 来 描述 物体 在 GCS 内 的 位 置 和 姿态 , 另 一 方面 为 物体 上 的 点 或 其 他 坐标 系 提 供 局 部 
的 确定 位 置 和 姿态 的 标准 。 


zZ Z PA 
wo Xo 

B _ \ "md 
-Ho sf \ -— -I 加 

t 7 I 

1 1 

9, Yi 

X A X 


(a) (b) (c) 
图 2.2.1 基本 的 坐标 系 
分 别 定义 欧 拉 角 如 下 。 


CD 航 角 : Ox 在 Oxy 平 面 的 投影 与 X WKH o. 
© 仰角 : Oz 在 Oxz 平 面 的 投影 与 Z 轴 夹 角 0。 
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C Rf: Oy 在 Oyz 平 面 的 投影 与 Y 轴 夹 角 gpg。 飞 行 器 坐标 系 到 惯性 坐标 系 的 转换 
矩阵 如 下 。 
cosWcos 风 cosysing cosWsinbgcos 风 十 sinjsin? 
R= R,R,R. = | sinycosg sinysinbgsing sinysingcosg 一 singcosy | (2. 2. D 
— sinf cosgsin 多 cosgcos 风 
在 建立 上 述 坐标 系 的 基础 上 , 且 无 风 低 速 飞行 的 情况 下 ,忽略 阻力 系数 ,可 以 得 到 以 
下 数学 模型 , 即 
X = (cosysingcos$ + sinysing)U | m 
X = (singsin£cos$-cosysin?)U: | m 
Z = (cos$cos0)U; | m 
$ = (LU: + — 1.)]]E L 
9 = (LU + 9I. — L.)]1 I, 
$= [LU, + 99 (1, — 1,)]1 I. 
其 中 ,各 字符 代表 含义 如 表 2.2.1 所 示 。 
表 2.2.1 字母 定义 


变量 & X 

L 旋翼 中 心 到 坐标 原点 的 距离 
m 飞行 器 质量 

U, 垂直 速度 控制 量 

U: 翻 深 输 入 控制 量 

Us 俯仰 控制 量 

U, 偏 航 控制 量 


四 旋翼 飞行 器 具有 6 个 自由 度 , 通 过 IMU 惯性 测量 单元 实时 测量 飞行 器 3 个 轴 向 
的 旋转 角速度 和 加 速度 ,进行 姿态 解 算 ( 即 对 数据 进行 处 理 融 合 后 得 到 当前 飞机 的 姿态 
信息 ) ,控制 飞行 器 的 4 个 输入 控制 量 ,飞行 器 即 可 达到 平衡 飞行 的 目的 。 


2.2.2 姿态 解 算 


姿态 解 算 是 捷 联 式 惯性 导航 系统 的 关键 技术 ,通过 姿态 矩阵 可 以 得 到 载体 的 姿态 和 
导航 参数 计算 需要 的 数据 ,是 捷 联 式 惯 导 算法 中 的 重要 工作 。 载 体 的 姿态 和 航向 体现 了 
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载体 坐标 系 与 导航 坐标 系 之 间 的 方位 关系 ,确定 两 个 坐标 系 之 间 的 方位 关系 需要 借助 矩 
阵 法 和 力学 中 的 刚体 定点 运动 的 位 移 定理 。 通 过 和 拖 阵 法 推导 方向 余弦 表 , 而 刚体 定点 运 
动 的 位 移 定理 表明 ,定点 运动 刚体 的 任何 有 限 位 移 都 可 以 绕 过 定点 的 某 一 轴 经 过 一 次 转 
动 来 实现 。 目 前 ,描述 动 坐标 相对 参考 坐标 系 方位 关系 的 方法 有 多 种 ,可 简单 地 将 其 分 
为 3 类 , 即 三 参数 法 、 四 参数 法 和 九 参数 法 。 三 参数 法 也 称 欧 拉 角 法 ,四 参数 法 通常 指 四 
元 数 法 , 九 参数 法 称 为 方向 余弦 法 。 

一 个 动 坐标 系 相对 参考 坐标 系 的 方位 可 以 完全 由 动 坐标 系 依次 绕 3 个 不 同 的 轴 转 
动 的 3 个 角度 来 确定 。 例 如 ,载体 坐标 系 作为 动 坐标 系 , 导 航 坐标 系 作为 参考 坐标 系 , 则 
姿态 角 即 为 一 组 欧 拉 角 , 按 一 定 的 转动 顺序 即 可 得 到 导航 坐标 系 到 载体 坐标 系 的 关系 。 


Y cosÜ sinysinü cosysing J| w E&LX 
|=| 。 coskosy — sinycosð | o EY (2.2.2) 
à 0 siny cosy o ELZ 


式 中 ,y、0 消 分 别 对 应 横 滚 (Roll) ,俯仰 (Pitch)、 航 向 (Yaw)3 个 姿态 角 , 根 据 欧 拉 角 
微分 方程 ,由 角速度 可 以 求解 3 个 姿态 角 。 欧 拉 角 微分 方程 式 只 有 3 个 ,但 每 个 方程 都 
含有 三 角 函 数 的 运算 ,计算 速度 慢 , 且 方程 会 出 现 “ 奇 点 ”, 使 方程 式 退 化 , 故 不 能 全 姿态 
工作 轨 。 因 此 , 欧 拉 角 法 难以 广泛 用 于 工程 实践 , 且 实 时 计算 困难 。 方 向 余弦 法 避免 了 
欧 拉 法 的 “ 奇 点 "现象 ,但 方程 的 计算 量 大 ,工作 效率 低 。 随 着 飞行 运载 体 导航 控制 系统 
的 迅速 发 展 和 数字 计算 机 在 运动 控制 中 的 应 用 ,控制 系统 要 求 导 航 计算 环节 能 更 加 合理 
地 描述 载体 的 刚体 空间 运动 ,四 元 数 法 的 研究 得 到 了 广泛 重视 。 

1. 四 元 数 算法 

四 元 数 法 是 捷 联 惯 导 中 的 一 种 算法 号 ,利用 陀螺 仪 . 加 速度 计 ( 有 条 件 的 时 候 可 以 加 
上 磁 强 计 ) 的 数据 ,将 四 轴 机 体 坐 标 系 与 地 球 坐 标 系 进行 耦合 ,最 后 计算 出 正确 的 四 轴 姿 
态 方位 数据 。 

四 元 数 的 数学 概念 是 1843 年 由 哈密 顿 首先 提出 的 , 它 是 代数 学 中 的 内 容 之 一 。 随 
着 捷 联 式 惯性 导航 技术 的 发 展 ,为 了 更 简便 地 描述 刚体 的 角 运 动 ,采用 了 四 元 数 这 个 数 
学 工具 ,用 它 来 弥补 通常 描述 刚体 角 运 动 的 3 个 欧 拉 角 参数 在 设计 控制 系统 时 的 不 足 。 
四 元 数 可 以 描述 一 个 坐标 系 或 一 个 矢量 相对 某 一 个 坐标 系 的 旋转 ,四 元 数 的 标量 部 分 表 
示 了 转角 的 一 半 余 弦 值 ,而 其 矢量 部 分 则 表示 瞬时 转轴 的 方向 ,瞬时 转动 轴 与 参考 坐标 
系 轴 间 的 方向 余弦 值 。 因 此 ,一 个 四 元 数 既 表示 了 转轴 的 方向 ,又 表示 了 转角 的 大 小 , 往 
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往 称 为 转动 四 元 数 。 
工程 上 一 般 运用 范 数 为 1 的 特征 四 元 数 ,特征 四 元 数 的 标量 部 分 表示 转角 的 一 般 余 
弦 值 ,其 矢量 部 分 表示 瞬时 转轴 的 方向 。 矢 量 R 相对 参考 坐标 系 旋转 一 个 转角 0 ,旋转 
轴 n 的 方向 由 四 元 数 的 虚 部 确定 ,cosa、cosB、cosy 表示 旋转 轴 与 参考 坐标 系 轴 间 的 方 
向 余弦 值 。 
R’ = qRq' (2:2:3) 
式 中 ,R HERE; g 二 po 十 pii 十 pzj 十 psk, 其 中 


-的 
Do s [5 
=al e os 
bi = sin 2 cosa 
p: = sin( 4 Jeose 


p: = sin( 4 Jeosy 

四 元 数 姿态 矩阵 微分 方程 式 只 要 解 4 个 一 阶 微分 方程 式 组 即 可 ,比方 向 余弦 姿态 矩 
阵 微 分 方程 式 计算 量 有 明显 的 减少 ,能 满足 工程 实践 中 对 实时 性 的 要 求 。 

2. 四 元 数 转 欧 拉 角 算 法 流程 

运用 机 体 上 搭载 的 加 速度 计 与 陀螺 的 数据 求 出 初始 欧 拉 角 。 为 了 获取 四 旋 沁 飞行 
器 当前 准确 .可 靠 的 姿态 信息 (俯仰 角 、 横 滚 角 、 偏 航 角 ) ,用 于 四 轴 的 平衡 及 运动 控制 ,应 
当 首先 进行 数据 融合 。 

D 单独 使 用 加 速度 计 测量 姿态 时 

加 速度 计 测量 对 象 为 比 力 ,理想 情况 下 想 要 得 到 的 是 重力 加 速度 分 量 ,但 是 任何 机 
械 系统 不 可 避免 存在 的 平 动 振动 也 会 产生 相当 大 的 加 速度 ,加 速度 计 特 别 容易 受 飞行 器 
机 架 振动 的 影响 ,振动 振幅 高 达 2 个 重力 单位 。 而 加 速度 计 完全 无 法 区 分 重力 加 速度 和 
外 力 加 速度 这 两 种 加 速度 。 所 以 加 速度 计 虽 然 能 够 精确 测量 出 当前 飞行 器 的 各 个 加 速 
度 分 量 , 且 测量 值 随 时 间 的 变化 相对 较 小 ,但 是 飞行 器 的 线性 振动 给 测量 引入 了 强烈 的 
噪声 ,使 得 这 个 数据 不 能 直接 使 用 。 

2) 单独 使 用 陀螺 仪 测量 姿态 时 

陀螺 仪 对 振动 不 敏感 , 受 外 部 影响 弱 , 稳 定性 好 :但 输出 量 为 角速度 ,需要 积分 才能 得 
到 姿态 。 短 期 内 这 个 姿态 数据 具有 很 大 的 参考 价值 ,但 是 由 于 陀螺 仪器 件 本 身 误差 的 存 
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在 ,会 导致 这 个 姿态 数据 随 着 长 时 间 的 积分 逐渐 偏离 正确 值 , 即 测量 值 随时 间 变化 比较 大 。 
因此 ,可 以 看 出 ,将 这 两 种 传感器 的 优 缺 点 互补 ,将 两 者 的 数据 融合 起 来 才能 得 到 更 
好 的 效果 。 
数据 融合 的 方法 有 很 多 种 ,Madgwick 的 IMUupdate 算法 就 是 其 中 之 一 。 
IMUupdate 算法 中 要 求 输入 6 个 数据 ,g- 、g,、g: 分 别 为 陀螺 仪 测量 到 的 3 个 旋转 角 
速度 分 量 ,a; .ay ,a: 则 为 加 速度 计 的 3 个 加 速度 分 量 ,IMUupdate 函数 体 如 下 : 


void IMUupdate(float gx, float gy, float gz, float ax, float ay, float az) 
首先 ,将 加 速度 计 测量 到 的 3 个 向 量 转换 为 单位 向 量 , 代 码 如 下 : 


norm = sqrt(ax*ax + ay*ay + az*az); 
ax- ax / norm; 
ay= ay / norm; 


az= az / norm; 


根据 余弦 矩阵 和 欧 拉 角 的 定义 ,将 地 理 坐 标 系 的 重力 向 量 转 到 机 体 坐 标 系 , 得 到 的 
v, yu: 其 实 就 是 在 当前 的 四 元 数 机 体 坐 标 参照 系 上 换算 出 来 的 重力 单位 向 量 , 即 
v. = 2(qqs — dod: ) 
v, = 2(qod + dq:41) 
V. = qoqo — didi — 4292 + q3q3 
az ay \q* 是 机 体 坐 标 参 照 系 上 加 速度 计 测 出 来 的 重力 向 量 , 也 就 是 实际 测 出 来 的 重 
力 向 量 。wv;、v,、v: 为 用 陀螺 积分 后 的 姿态 来 推算 出 的 重力 向 量 , 它 们 都 是 机 体 坐 标 参 照 
系 上 的 重力 向 量 。 那 它们 之 间 的 误差 向 量 , 就 是 陀螺 积分 后 的 姿态 和 加 速度 计 测 出 来 的 
姿态 之 间 的 误差 。 向 量 间 的 误差 ,可 以 用 向 量 又 积 ( 也 叫 向 量 外 积 、 又 乘 ) 来 表示 ,er 、e,、 
e: 就 是 两 个 重力 向 量 的 又 积 , 即 
€, = (aV: —a.v,) 
ey — (8,0, —a. V.) 
e, = (d;0, —,v.) 
这 个 向 量 又 积 仍然 是 位 于 机 体 坐 标 系 上 的 ,而 陀螺 积分 误差 也 是 在 机 体 坐 标 系 上 ， 
而 且 叉 积 的 大 小 与 陀螺 积分 误差 成 正比 ,正好 拿 来 纠正 陀螺 。 由 于 陀螺 是 对 机 体 直接 积 
分 ,所 以 对 陀螺 的 纠正 量 会 直接 体现 在 对 机 体 坐 标 系 的 纠正 。 用 叉 积 误差 e,、e,、e: 来 做 
PI 调节 ,最 后 用 得 到 的 调节 量 对 陀螺 仪 进行 零 偏 修正 ,代码 如 下 : 
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//integral error scaled integral gain 
exInt = exInt + ex* Ki; 

eyInt = eyInt + ey*Ki; 

ezInt = ezInt + ez* Ki; 

/ /adjusted gyroscope measurements 

gx = gx + Kp*ex * exInt; 

gy = gy + Kp*ey + eyInt; 

gz = gz + Kp*ez + ezInt; 


其 中 定义 了 Kp 和 Ki 的 值 为 


#define Kp 1.6f 
#define Ki 0.001f 


在 上 一 步 已 经 得 到 了 修正 过 零 偏 的 陀螺 仪 数据 g; 、g,、g: ,在 这 里 设 机体 坐 标 系 相对 
平台 坐标 系 的 转动 四 元 素 为 
Q = qo c qi, c qijid qsks 
然后 使 用 一 阶 龙 格 一 库 塔 法 对 陀螺 仪 角速度 值 进行 处 理 更 新 得 到 新 的 四 元 数值 。 
一 阶 龙 格 一 库 塔 法 计算 式 为 
q(t+T)= g(t)+ TO, (tg (t) 
将 角速度 值 代入 上 式 展开 .得 到 


q (CT) p (+ F [5 s Om () eq C) wgs (2) ] 
«iQ T)— q GO) T Des Os () wage (1) — wgs (1) ] 


qi (t+ T) qi C) F Des Os C) wagi Qd qs (1) ] 


qi UHT)= q Q9 T Eus (99 (0)+ wq 0) wg (t) ] 
具体 的 实现 代码 如 下 


# define halfT 0. 001f 
q0 = q0 + (-ai*gx - q2*gy - q3 * gz) * halfT; 


ql = qi + (q0*gx + q2*gz — q3 * gy) * halfT; 
q2 = q2 + (q0*gy - ql*gz + q3 * gx) * halfT; 
q3 = q3 + (q0*gz + qi*gy - q2 * gx) * halfT; 


其 中 定义 了 halfT 的 值 为 0. 001 ,代表 四 元 数 固 定 为 2ms 更 新 一 次 数据 ,halfT 取 值 
为 周期 的 一 半 , 即 T/2。 
在 上 面 的 四 元 数 微分 方程 更 新 了 四 元 数 数据 后 ,还 需要 将 得 到 的 四 元 数 进行 规范 化 
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处 理 , 规 范 化 的 公式 及 过 程 代码 如 下 : 
q = (2.2.4) 
as qi didi 
norm = sqrt( q0*q0 + qlx*ql + q2*q2 + q3*q3) 
q0 = q0/norm 
ql = ql/norm 
q2 = q2/norm 
q3 = q3/norm 


至 此 已 经 获取 到 了 稳定 有效 的 姿态 四 元 数 数据 ,但 由 于 在 设计 控制 规律 时 , 欧 拉 角 
的 直观 性 和 几何 意义 仍然 采用 欧 拉 角 描述 ,因此 还 需要 将 四 元 数 转换 为 欧 拉 角 , 即 


arctân 2 (qoqi + 4243 ) 


$ 1 一 2(qi 十 qz) 
0 |= | arctan(2(qds — 4143) ) (2.2,5) 
v stan 2(gogs + gz) 

arctan 1 20 TH qD 


arctan 的 结果 是 ,这 并 不 能 够 覆盖 所 有 的 角度 (对 于 角 的 取 值 范 围 已 经 满足 ) ,因此 
需要 用 arctan2 来 代替 arctan ,修正 后 的 公式 为 


$ arctan2(2 (qoqi + qq ) 1 — 2(qi + qd )) 
0 |= | arcsin(2(qoq: — 4143) ) (2.2.6) 
y arctan2(2 (qoqs + qiq: ) 1 — 2 (g? +45 )) 


实际 C 语言 代码 如 下 : 

angle-» pit = asin(-2 * gl * q3 + 2 * q0* q2) * 57.3; 

angle-»rol = -atan2(2* q2 * q3 + 2 * q0 * ql, -2 * ql * ql - 2 * q2* q2 + 1)* 
53.3; 

angle-» yaw = atan2(2 * (q0 * q3 + ql * q2), 1 - 2*q2*q2 - 2*q93*93) * 57.3; 


EZAMI NEI KIT a Fa AE T dE 8035 5 fü EE. T VARI Vult fr fao 
控制 中 。 


2.3 平衡 控制 算法 


2.3.1 四 旋翼 飞行 器 的 PID 调节 原理 


飞行 控制 部 分 解码 出 遥控 信和 号 或 者 采集 到 姿态 传感器 数据 之 后 ,随即 将 两 者 进行 融 
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合 ,根据 融合 的 结果 对 姿态 进行 相应 调整 , 即 通过 PWM 信号 对 电机 进行 控制 ,这 时 就 需 
要 设置 合适 的 PID 控制 率 来 输出 合适 的 控制 量 , 以 避免 电机 转速 大 幅度 的 变化 而 引起 飞 
行 器 剧烈 抖动 。 

工业 控制 领域 将 这 种 把 偏差 的 比例 .积分 和 微分 通过 线性 组 合 构成 控制 量 ,用 这 一 
控制 量 对 被 控制 对 象 进行 控制 的 方法 称 为 PID 控制 中 ,原理 如 图 2. 3. 1 所 示 。 


- 比例 项 


H t 
期 望 值 iG <0 | uy NUN 和 


=| ”微分 项 


反馈 
图 2.3.1 PID 控 制 原理 框图 


PID 控制 的 优势 在 于 结构 简单 .数学 原理 清晰 、 易 于 实现 且 性 能 优良 ,常用 的 公式 为 
u(t)= Fee Kleert Ko( eA) 
(2,3, 1) 
e(t) — za(t)— z(t) 

式 中 ,e(z) 为 期 望 值 与 当前 状态 值 的 偏差 ; w(z) 为 PID 调节 后 的 系统 控制 输入 量 ; Kp Ki 
和 Ko 分 别 为 PID 控制 器 的 比例 系数 、 积 分 系数 和 微分 系数 。 简 单 来 说 ,PID 控制 器 各 校 

正 环 节 的 作用 如 下 。 

1. 比例 环节 


比例 控制 是 一 种 最 简单 的 控制 方式 。 其 控制 器 的 输出 与 输入 误差 信号 成 比例 关系 。 
偏差 一 旦 产生 ,控制 器 立即 发 生 作用 调节 控制 输出 ,使 被 控 量 朝 着 减 小 偏差 的 方向 变化 ， 
偏差 减 小 的 速度 取决 于 比例 系数 Kp ,Ke 越 大 则 偏差 减 小 得 越 快 。 

2. 积分 环节 

在 积分 控制 中 ,控制 器 的 输出 与 输入 误差 信号 的 积分 成 正比 关系 。 对 一 个 自动 控制 
系统 ,如 果 在 进入 稳 态 后 存在 稳 态 误差 , 则 称 这 个 控制 系统 是 有 稳 态 误差 的 或 简称 有 差 
系统 。 为 了 消除 稳 态 误差 ,在 控制 器 中 必须 引入 “积分 项 *。 积 分 项 误差 取决 于 时 间 的 积 
分 , 随 着 时 间 的 增加 ,积分 项 会 增 大 。 这 样 ,即便 误差 很 小 ,积分 项 也 会 随 着 时 间 的 增加 
而 加 大 , 它 推动 控制 器 的 输出 增 大 使 稳 态 误差 进一步 减 小 ,直到 等 于 零 。 
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3. 微分 环节 

在 微分 控制 中 ,控制 器 的 输出 与 输入 误差 信号 的 微分 ( 即 误差 的 变化 率 ) 成 正比 关 
系 。 自 动 控 制 系统 在 克服 误差 的 调节 过 程 中 可 能 会 出 现 振荡 甚至 失 稳 。 其 原因 是 由 于 
存在 有 和 较 大 惯性 组 件 ( 环 节 ) 或 有 滞后 组 件 ,具有 抑制 误差 的 作用 ,其 变化 总 是 落后 于 误 
差 的 变化 。 解 决 的 办 法 是 使 抑制 误差 的 作用 的 变化 “超前 ”, 即 在 误差 接近 零 时 ,抑制 误 
差 的 作用 就 应 该 是 零 。 

由 于 在 单片机 数字 系统 中 ,单片机 控制 是 一 种 采样 控制 , 它 只 能 根据 采样 时 刻 的 偏 
差 值 计算 控制 量 ,所 以 使 用 的 是 数字 PID 控制 器 ,数字 PID 控制 算法 通常 又 分 为 位 置式 
PID 控制 算法 和 增 量 式 PID 控制 算法 。 

1) 位 置式 PID 控制 算法 

对 原始 PID 控制 函数 进行 离散 化 处 理 ,对 于 模拟 PID 控制 算法 ,用 一 系列 的 采样 时 
刻 点 AT 代表 连续 的 时 间 z, 以 和 式 代表 积分 ,以 增 量 代表 微分 , 则 可 得 到 

t=kT (k=0,1,2,°…) 


t k k 
e(t)dt œT 2? ,e(jT) — T Jej) 
i D d p j (2.3.2) 


de(t) ~ e(&T )—e[ (e — L)T] e(k)— e(k—1) 
dt T T 


式 中 ,了 为 采样 周期 。 当 然 , 在 上 述 离散 化 过 程 中 ,采样 周期 必须 足够 短 才能 保证 有 足够 
的 精度 。 为 了 使 式 子 看 起 来 简洁 ,将 eC(kT) 简 化 表示 为 e(k), 可 得 到 离散 的 PID 表达 
式 为 


k 
ú(k)= KeLe(&)4 i 2160 T* Celk) e(k —1))] (2.3.3) 


将 上 式 展开 ,得 到 的 三 项 分 别 为 比例 项 、 积 分 项 和 微分 项 。 由 于 单片机 输出 的 uk) 
直接 去 控制 执行 机 构 ( 如 阀门 ),u(k) 的 值 和 执行 机 构 的 位 置 (如 阀门 的 打开 程度 ) 是 一 一 
对 应 的 ,所 以 通常 称 该 式 为 位 置式 PID 控制 算法 ,其 流程 如 图 2. 3. 2 所 示 。 


mE) + elk) PID | xb uD [执行 | 被 控 e(t) 
"e umma] 700^] "e| pue E 


bs K 


T 


图 2.3.2 位 置式 PID 控制 系统 


第 2 章 ”四 旋翼 飞行 器 飞行 原理 |> 29 


这 种 控制 算法 的 缺点 是 : 由 于 是 全 量 输出 ,所 以 每 次 输出 都 和 过 去 的 状态 有 关 , 计 算 
时 会 对 e(k) 进 行 累加 ,工作 量 较 大 ; 单片机 输出 的 uk) 对 应 的 是 执行 机 构 的 实际 位 置 ， 
如 果 计 算出 现 故 障 , 则 输出 的 Ce) 会 产生 大 幅度 变化 ,引起 执行 机 构 的 大 幅度 变化 。 在 
实际 应 用 中 ,一 些 安全 性 要 求 较 高 的 系统 必然 要 避免 出 现 这 种 现象 ,因此 产生 了 增 量 式 
PID 控制 算法 , 即 数字 控制 器 的 输出 只 是 控制 量 的 增 量 。 

2) 增 量 式 PID 控制 算法 

由 式 (2. 3. 3) ,根据 递 推 原理 可 得 


u(k—1)= KeLe(k DE Seg» t S(e(k—1)—e(k—2))] (2.3.4) 
将 式 (2. 2. 3) 减 去 式 (2. 2. 4 ,得 
Au(k)— u(k)—u(k —1)— Ae (k)+ Be(k —1)3- Ce(& —2) 


a Ta 
A=Kp (i £5) 


2T, 
B= K+ +) 
C= K.T,/T 


A.B\C 都 是 与 采样 周期 比例 系数 、 积 分 时 间 常 数 、 微 分 时 间 常 数 有 关 的 系数 。 可 以 
看 出 ,只 要 使 用 前 后 3 次 测量 值 的 偏差 即 可 由 上 式 求 出 控制 增 量 ,流程 图 如 2. 3. 3 所 示 。 


1D t G9 FA Au(k) ul) | 执行 被 控 «0. 
l, ma M 机 构 对 象 | 


ib uis 


^ 
图 2.3.3 增 量 式 PID 控制 系统 

就 整个 系统 而 言 ,位 置式 与 增 量 式 PID 控制 算法 并 无 本 质 区 别 , 增 量 式 控制 虽然 只 
是 算法 上 做 了 一 点 改进 , 却 带 来 了 不 少 优点 。 

CD 由 于 单片机 输出 增 量 , 所 以 误 动 作 时 影响 小 ,必要 时 可 以 用 逻辑 判断 的 方法 去 掉 。 

© 手动 /自动 控制 切换 时 冲击 小 ,以 便于 实现 无 扰动 切换 。 

O 算式 中 不 需要 累加 运算 ,控制 增 量 的 确定 仅 与 最 近 & 次 的 采样 值 有 关 , 所 以 较 容 
易 通 过 加 权 处 理 获得 比较 好 的 控制 效果 。 

在 后 面 的 各 个 控制 环节 中 根据 其 控制 环节 的 控制 特性 的 不 同 选用 合适 的 PID 控制 
算法 。 对 于 一 般 四 旋 沟 飞行 器 而 言 ,有 6 个 状态 检测 量 (3 个 空间 坐标 值 和 3 个 角度 值 )， 
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但 是 只 有 4 个 控制 输出 量 (4 个 电机 转速 )。 总 体 升 力 工 决 定 四 旋 避 飞行 器 Z 轴 方 向 的 
加 速度 ,从 而 保证 飞行 器 保持 在 空中 ,扭力 rs 则 决定 着 3 个 姿态 角 的 角 加 速度 ,因此 对 于 
四 旋涡 飞行 器 仿真 ,此 处 也 可 以 采用 简易 版 的 PD 控制 器 , 即 


m 


ü 
CC; 


T= (E+ Ko 7 2) Kee 7 9) 


T, — (Ko (du — 4)9- Koo ($a = 4) Ms 
re = Kop (04 — 0)-- Ko (0a 一 0)) L,, 
Ty = (Kop (Ja — 9)9- Kee (Ja — Y) I = 
结合 电机 的 转速 , 便 能 计算 出 达到 期 望 状态 所 需 的 电机 控制 量 ,仿真 用 电机 转速 表 


示 为 
uu 9 x- 
aoia 
o= Tyi E 
o= Tyi +E 
PID 计算 的 程序 如 下 : 


double PIDCalc( PID * pp，double NextPoint ) 


f 
double dError, Error; 


Error = pp 一 > SetPoint - NextPoint; // 偏 差 
pp-»SumError += Error; // 积 分 
dError = pp 一 >LastError - pp- > PrevError; // 当 前 微分 


PP 一 > PrevError = pp 一 > LastError; 
PP 一 > LastError = Error; 


return (pp 一 > Proportion * Error // 比 例 项 
+ pp-> Integral * pp 一 > SumError // 积 分 项 
+ pp-> Derivative * dError // 微 分 项 


); 
} 


PID 程序 设计 流程 图 如 2.3.4 所 示 。 
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初始 化 PID 参 数 
1 
开启 定时 器 
e 全、 是 _| 根据 PID 计 算 公式 
学 待定 时 器 中 断 ? 计算 输出 量 
5 


[92.3.4 PID 程序 设计 流程 图 


2.3.2 四 旋翼 飞行 器 的 PID 参数 整定 (利用 MATLAB 仿真 
确定 理论 参数 ) 


PID 算法 能 让 被 控 系 统 表 现 出 优良 的 性 能 ,但 这 在 很 大 程度 上 取决 于 所 选取 的 3 个 
参数 。 选 取 3 个 参数 值 ,在 实际 系统 中 受到 一 些 条 件 约束 ,常常 凭借 经 验 通过 人 工 测 试 
选取 ,这 既 费 时 又 费力 ,而 且 还 不 能 确保 所 选取 的 值 是 否 为 最 优 。 在 仿真 系统 中 ,试验 可 
以 被 任意 次 地 重复 ,从 而 给 自动 选取 最 优 PID 参数 提供 了 可 能 ,仿真 系统 与 实际 系统 越 
接近 , 则 选取 的 PID 参数 越 具有 参考 价值 。 自 动 选 取 最 优 PID 参数 的 算法 有 很 多 ,如 内 
部 模型 控制 ,遗传 算法 (GA) 和 进化 计算 技术 ,此 处 选用 简化 版 的 极 值 搜索 算法 。 

该 算法 思想 很 简单 , 即 找到 一 组 最 优 参 数 0 — (Ko «Ky Ko ) ,使 得 设 定 的 代价 函数 


10)7 [e ota (2.3.5) 


t — todi 
值 最 小 。 此 代价 函数 用 来 对 误差 进行 评估 ,单位 时 间 内 偏差 越 大 则 该 值 越 大 ,其 中 的 
elt,0 ) 表 示 在 设 定 参 数 为 8 时 ,在 有 初始 干扰 的 情况 下 ,实际 轨迹 (坐标 值 集合 ) 与 参考 值 
之 间 的 偏差 。 假 如 可 以 计算 代价 函数 J(6 ) 的 梯度 VJ (8 ) ,那么 只 要 按照 梯度 下 降 算法 
就 可 以 不 断 地 改善 参数 值 , 即 
0 (k--1)— 0 (k)—a V (0) (2.3.6) 
式 中 ,0 (k) 为 次 迭代 后 的 参数 值 ; a 为 调节 系数 ,表示 每 次 调节 的 力度 , 当 &A-~cc 时 , 代 
价 函 数 J(6 ) 达 到 局 部 最 优 值 。J (6 ) 的 定义 式 为 


VI (0) (5g 6g Dl) (2. 3. 7) 


32 4| 四 旋翼 飞行 器 设计 与 实现 


根据 J (O ) 可 以 近似 计算 它 的 偏 导 , 即 


J(0+6°u)— (0—6. u) 
28 


IXP iu 2877 Fa KS SÉ for p] fi. 24 0 m0 时 这 种 近似 更 加 精确 。 至 此 ,根据 式 (2. 3. 5) — 
式 (2. 3.8), 便 可 以 计算 代价 函数 的 最 小 值 和 局 部 最 优 参数 组 。 算 法 流程 如 图 2. 3. 5 
所 示 。 


9 
agl O~ (2.3.8) 


一 一 一 一 一 一 初始 化 9=(Kp, Ki. Kp) 


Y 
对 系统 加 入 干扰 


1 f 2 
计算 /6 六 一 一 f e(t. gy dt 


Tho 


Y 
NO+6: u)-(0-6 up) 


HH A8) 5; 


Y 
更 新 参数 (ttD=6(O-cV6) 


1 


BIWLTIR. Tui UG" 7s [7t à 


te—to? f 


8 ) 达 标 或 者 迭代 fi 
最 大 次 数 ? 
是 
| 记录 全 局 最 优 值 gaw=6 
E 


2.3.5 PID 参数 自动 选取 算法 
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2.4 滤波 算法 


2.4.1 卡尔 曼 滤 法 算法 


由 于 加 速度 计 本 身 的 特性 ,以 及 飞行 器 4 个 电机 和 机 体 的 振动 ,安装 在 飞行 器 上 的 
三 轴 加 速度 计 采 集 的 3 个 轴 的 角速度 co 数据 含 大 量 的 噪声 ,而 陀螺 仪 本 身受 噪声 影响 较 
小 ,因此 必须 要 采取 一 种 算法 ,对 加 速度 计 的 数据 进行 滤波 ,去 除 噪声 ,再 和 陀螺 仪 的 数 
据 进行 融合 ,以 消除 陀螺 仪 的 累积 误差 ,从 而 得 到 飞行 器 正确 的 姿态 。 一 种 理想 的 算法 
应 具有 以 下 特性 。 

(D 积分 数值 漂移 小 。 在 离散 系统 中 ,常用 数据 的 累加 代表 积分 。 但 如 果 对 采集 到 的 
陀螺 仪 数据 直接 积分 ,得 到 的 数据 并 不 稳定 ,无 法 真实 地 反映 姿态 数据 ,因此 需要 用 加 速 
度 计 补偿 陀螺 ,使 积分 稳定 下 来 。 

© 能 较 好 地 处 理 较 小 的 积分 。 某 一 个 轴 向 的 积分 越 多 , 则 Ail_cal/Ele_cal 等 越 大 ， 
电机 的 反应 也 会 越 大 。 而 如 果 只 倾斜 了 很 小 角度 , 则 电机 没有 足够 的 力量 来 拉平 这 个 小 
角度 ; 如 果 融 合 后 的 积分 在 小 角度 没有 拉平 时 一 直 变 大 , 则 电机 有 足够 的 力量 拉平 小 
角度 。 

© 积分 数值 不 溢出 。 积 分 数值 相对 于 电机 数值 应 该 不 能 太 大 ,以 便 计算 kp 、k1、kp 参 
数 。 由 于 积分 是 始终 不 清 零 的 ,因此 用 于 反映 姿态 数据 的 关键 参数 时 还 需要 做 好 数据 类 
型 的 设计 与 限 幅 ,以 防止 溢出 。 

@ 长 期 稳定 性 。 算 法 应 该 尽量 健壮 有 效 ,程序 不 会 跑 飞 ,即使 工作 了 很 久 ,不 论 是 零 
点 积分 还 是 晃动 之 后 的 调整 反应 ,都 应 该 是 迅速 有 效 的 。 

C 与 后 期 PID 算法 的 配合 。 

卡尔 曼 算法 是 一 种 “最 优化 自 回归 数据 处 理 算法 (Optimal Recursive Data 
Processing Algorithm)”, 对 于 解决 很 大 部 分 的 问题 , 它 是 最 优 、 效 率 最 高 的 算法 中 。1960 
年 ,匈牙利 数学 家 和 鲁 道 夫 ， 卡尔 曼 提出 了 卡尔 曼 滤波 的 算法 。 卡 尔 曼 滤波 的 思路 并 不 是 
得 出 完全 正确 无 误 的 当前 状态 ,而 是 采用 一 种 递归 自 更 新 的 方法 来 估计 出 当前 的 状态 ， 
且 保 证 原状 态 与 估计 出 来 的 状态 的 均 方 误差 收敛 至 最 小 。 卡 尔 曼 算法 的 广泛 应 用 已 经 
超过 50 年 ,其 应 用 领域 包括 机 器 人 导航 ,控制 ,传感器 数据 融合 甚至 在 军事 方面 的 雷达 系 
统 以 及 导弹 追踪 等 。 
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一 般 测 得 的 信号 都 是 受到 噪声 干扰 的 ,如 加 速度 计 所 测 的 信号 。 怎 样 有 效 地 抑制 或 
消除 噪声 ,将 所 需 信号 完整 提取 出 来 ,是 信号 处 理 的 目的 。 滤 除 噪声 的 系统 称 为 滤波 器 。 
先 只 考虑 加 性 噪声 的 影响 ,观测 数据 z(z) 是 信号 *(z) 与 噪声 vw(z) 之 和 (如 图 2.4.1 所 
示 ), 即 

aD = s(n) + vn) 
一 般 的 信号 处 理 模 型 如 图 2. 4. 2 所 示 。 


x(n)=s(n)tu(n) 


s(n) x(n) 
x(n) xi) 
v(n) s(n)+u(n) hn) 


图 2.4.1 观测 数据 .信号 与 噪声 的 关系 图 2.4.2 一 般 信号 处 理 模型 
假设 信号 和 噪声 没有 相关 性 ( 即 互相 关 为 0) , 则 有 
Ha (2)= S22 Su (2) (2.4.1) 


Sa (z) Su(z) 十 Su(z) 

由 此 可 见 : 没有 噪声 时 ,信号 得 到 还 原 ;, 没 有 输入 信号 时 ,噪声 完全 被 滤 除 。 维 纳 滤 
波 能 够 随 着 信号 的 强 弱 自 适 应 地 将 噪声 抑制 掉 。 

维 纳 滤波 的 依据 是 全 部 的 过 去 测量 值 和 当前 状态 上 时 刻下 的 测量 值 进行 比 对 ,以 这 
二 者 误差 的 均 方 值 收敛 到 某 个 最 小 值 为 目标 。 维 纳 滤波 的 结果 是 一 个 确定 的 传递 函数 
瓦 。 卡 尔 曼 滤波 所 需 的 样本 依据 只 是 当前 状态 时刻 的 估计 值 和 前 一 个 状态 & 一 1 时 刻 
的 测量 值 通 过 不 断 递 归 更 新 的 方法 ,并 不 需要 追溯 过 去 所 有 的 观测 值 ,但 是 目标 同样 是 
误差 的 均 方 值 收敛 到 最 小 值 。 卡 尔 曼 滤波 的 结果 是 预 估 的 状态 值 。 卡 尔 曼 滤 波 具有 以 
下 特点 。 

O 采用 递归 的 算法 。 递 归 的 算法 就 是 将 & 时刻 卡尔 曼 滤波 计算 得 出 的 状态 值 作为 
k 十 1 时 刻 的 测量 值 。 

@ 用 递归 法 计算 并 不 需要 知道 全 部 过 去 的 值 ,用 状态 方程 描述 状态 变量 的 动态 变化 
规律 ,因此 信号 可 以 是 平稳 的 ,也 可 以 是 非 平稳 的 。 卡 尔 曼 滤 波 适用 于 平稳 和 非 平 稳 过 
程 。 从 这 一 点 可 以 看 出 ,采用 卡尔 曼 滤 波 算法 控制 姿态 的 飞行 器 ,其 初始 状态 可 以 不 是 

@ 卡尔 曼 滤 波 采取 的 误差 准则 为 估计 误差 的 均 方 值 最 小 。 假 设 某 系 统 & 时 刻 的 状 
态 变量 为 zx, 则 状态 方程 和 量 测 方程 ,也 就 是 输出 方程 ,表示 为 
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Tih 一 A. Ti ws (2.4.2) 
» = C, x, ui (2.4.3) 
式 中 ,4 为 时 间 , 指 系统 的 第 A 时 刻 相应 时 刻 信号 的 取 值 ; ze+, 为 上 十 ! 时 刻 的 状态 变量 ; 
vig k 时 刻 的 输出 信号 ; CLOS Re 时 刻 状 态 变量 zx 与 输出 信号 之 间 的 增益 矩阵 。 卡 尔 曼 滤 


波 信号 处 理 模 型 如 图 2. 4. 3 所 示 。 
M 
=| C, n -— 


O-1 
十 =| z 
T u 
Aia 


图 2.4.3 卡尔 曼 滤 波 信号 处 理 模型 


将 状态 方程 中 时 间 变 量 & 用 k 一 /代替 ,得 到 的 状态 方程 为 
Th = A, Zea we (2.4.4) 
那么 输出 方程 为 
y) = €, Ta v, (2.4.5) 
基于 一 些 理想 的 假设 ,有 
we:E[lo]=0, oa — Qe Yo = Qr Òn 
va:E[lv]=0, o =R, yw — Rs 
Ta f k=j 
0 kzj 
其 中 , 先 忽略 系统 中 测 得 的 噪声 和 输入 系统 的 信号 ,假设 这 二 者 为 零 。 卡 尔 曼 滤波 
递 推 回归 的 思路 是 这 样 的 : 先 得 估计 状态 变量 以 及 估计 输出 信号 ,得 到 这 二 者 的 估计 值 。 
目标 是 让 状态 变量 的 预 估 与 实际 状态 变量 测量 值 的 差 值 即 均 方差 收敛 以 达到 最 小 ,就 必 
须 用 输出 信号 的 估计 值 通过 某 种 加 权 来 修正 状态 变量 的 估计 值 。 因 此 ,卡尔 曼 滤 波 算法 
实现 的 基础 是 得 到 使 均 方 误差 达到 最 小 的 加 权 和 矩阵 的 最 优 值 。 
现在 先 假设 输入 信号 和 观测 噪声 为 零 , 此 时 的 状态 方程 为 
= A) £ka (2.4.6) 


量 测 方程 为 
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n=O 2,— CAL Zia (2. 4. 7) 
式 中 ,Ai 为 增益 参数 矩阵 ; Ci 为 校正 参数 矩阵 。 
假设 噪声 为 0, 有 一 个 误差 存在 于 输出 信号 的 估计 值 与 实测 值 之 间 , 这 个 误差 值 用 yi 
表示 ,那么 就 有 
» —»—5 (2.4.8) 
根据 卡尔 曼 滤 波 的 递 推 思想 ,为 了 提高 状态 估计 的 准确 度 , 用 输出 信号 的 估计 误差 
来 校正 状态 变量 。 于 是 就 得 到 


Zi= Ak Tea + H; (yx — 5) 


= Ar £ia + H, Gy — CA, ema) (2.4.9) 
xh. Hi Jy — T WBORB FE. 
经 过 校正 后 的 状态 变量 的 估计 误差 及 其 均 方 值 分 别 用 z 和 Pi 来 表示 。 把 未 经 校正 
的 状态 变量 的 估计 误差 的 均 方 值 用 Pi 来 表示 。 校 正 后 的 状态 变量 为 


dà = x, — X (2. 4. 10) 
即 状态 变量 减 去 不 考虑 噪声 时 的 状态 变量 ,那么 均 方 值 为 
P,— EL (x1 — 2h) (£a —24)"] (2:411) 
未 经 过 校正 的 均 方 值 为 
P, = E[(z —£) (n — 2)*] (2.4.12) 


按照 卡尔 曼 滤波 算法 ,状态 变量 的 估计 值 与 实际 值 的 误差 的 均 方 值 要 达到 最 小 ,首先 要 
推导 出 状态 变量 的 估计 值 和 估计 误差 之 间 的 关系 式 , 再 调整 HH 使 P, 达 到 最 小 。 
那么 要 得 到 卡尔 曼 滤波 的 递 推 公式 , 先 推导 状态 变量 的 估计 值 和 状态 变量 的 估计 误 
差 , 然 后 再 计算 均 方 值 Pi ,之 后 再 通过 化 简 得 到 卡尔 曼 滤波 算法 4 个 递 推 公式 , 即 
Zi = Aka F Hi Cyr — CiA s Xa 
H, = PACE (C,P;Ci +R) 
(2.4.13) 
P= AP Ai 十 OU 
P, = (I— HC )P; 
卡尔 曼 滤波 算法 的 递 推 流程 如 下 。 
D 从 一 个 时 刻 的 状态 变量 的 估计 值 _, 和 它 的 均 方 值 P;_1 导 出 未 更 新 的 均 方 值 : 
及 一 AiPe4T 十 On 。 
© 得 到 的 RRA H, =PC] (GPCI +R) ^ rb SI BUS ORTE H, o 
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© 3t HARAT: — AiZLa HH; Gy - GA sZi i £858], 

图 3f HARA P, — (I 一 HiCi )Pt £8 8] PL, 

至 此 ,完成 了 卡尔 曼 滤波 的 一 次 完整 的 递 推 过 程 。 卡 尔 曼 滤波 是 不 断 递归 的 运算 过 
程 ,因此 在 完成 前 一 次 的 递 推 过 程 后 ,就 变 为 下 一 次 递 推 运算 的 输入 。 由 此 可 以 看 出 ,车 
起 始 状 态 是 非 稳 态 , 则 卡尔 曼 滤 波 需要 一 定 的 时 间 进 行车 干 次 递归 运算 来 达到 稳 态 的 收 
敛 的 输出 值 。 


2.4.2 互补 滤波 算法 


互补 滤波 算法 的 思路 是 ,加 速度 计 由 于 其 自身 灵敏 度 较 高 。 在 振动 较 大 的 场合 ,加 
速度 计 的 测量 值 容易 混和 人 振动 等 噪声 中 。 也 就 是 说 ,加 速度 计 在 瞬时 精度 上 容易 受到 外 
部 干扰 而 有 很 大 误差 ,直接 用 加 速度 计 瞬 时 值 通过 三 角 函 数 计算 得 出 的 角度 误差 很 大 。 
陀螺 仪 的 测量 值 是 角速度 。 短 时 间 内 将 角速度 按时 间 积 分 得 到 的 角度 是 比较 准确 的 。 
但 是 此 时 得 到 的 角度 带 有 累积 误差 ,可 以 利用 这 两 种 传感器 的 特性 来 互补 得 到 正确 的 角 
度 。 实 现 互补 滤波 的 思路 就 是 将 加 速度 计 测量 值 做 一 个 均值 ,通过 三 角 函 数 计算 出 角 
度 , 利 用 这 个 值 来 视 时 间 长 短 加 权 校 正 陀螺 仪 测 得 并 换算 的 角度 值 ,达到 去 除 陀螺 仪 角 
度 累 积 误 差 的 效果 。 简 单 来 说 ,就 是 短 时 间 内 陀螺 仪 的 测量 值 比较 准确 ,以 它 为 主 来 计 
算得 到 姿态 ;长 时 间 上 看 用 加 速度 计 滤波 后 的 测量 值 比较 准确 ,这 时 候 加 大 加 速度 计 纠 
正 偏差 的 加 权 比 例 。 

互补 滤波 算法 就 是 把 加 速度 计算 出 的 角度 取 均 值 ,构造 成 角度 上 的 校正 量 , 释 加 到 
陀螺 仪 测 出 的 角度 上 ,实现 数据 融合 。 实 现 过 程 是 将 加 速度 计 的 数据 进行 均值 运算 。 均 
值 后 的 加 速度 计 值 为 


a. = 151, A. (2.4.14) 
式 中 ,a 为 均值 后 的 加 速度 计 值 。 设 g 为 重力 加 速度 , 先 用 ce 换算 出 角度 Acc , 即 
= see. 
cc — arccos ( p ) (2.4.15) 
陀螺 仪 测 得 的 角速度 经 过 积分 可 以 计算 出 角度 , 即 
0 = [od (2.4.16) 


互补 滤波 融合 的 公式 为 
G» (02-6,)2- A * Acc (2. 4.17) 
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更 新 姿态 角 , 则 融合 后 的 角度 为 
0—G- (0+ [ dt +A » arccos (&) (2.4.18) 
最 终 修正 值 9 即 为 融合 后 的 角度 。G 和 A 是 根据 时 间 常 数 计算 出 来 的 参数 , 且 在 应 
用 中 主要 是 调节 这 两 个 值 的 大 小 。 在 短 时 间 内 以 陀螺 仪 为 主 , 长 时 间 上 是 趋 近 于 加 速度 
计 的 加 权 平 均值 。 互 补 滤波 器 的 流程 框图 如 图 2.4.4 所 示 o 


加 速度 计 “上 一 | ly e| arcos =| 4 
pm [Eg Se - 8 
图 2.4.4 互补 滤波 器 流程 框图 
常用 于 加 速度 计 和 陀螺 仪 数据 融合 的 算法 有 一 阶 互补 滤波 算法 、 二 阶 互补 滤波 算法 
和 卡尔 曼 滤 波 算法 。 下 面 对 各 种 算法 进行 说 明 。 
1. 一 阶 互补 滤波 
一 阶 互补 滤波 指 的 是 对 加 速度 计 和 陀螺 仪 计算 而 得 的 角度 数据 进行 简单 加 权 。 实 


现 一 阶 互 补 滤波 的 程序 代码 如 下 : 


K = 0.075; // 对 加 速度 计 取 值 的 权重 
float A = K/ (K + dt); 

Com angle = A * (Com angle + omega * dt) + (1-A) * angleà; 

//Con angle 为 融合 角度 值 , omega 为 角速度 ,dt 为 采样 间隔 ,anglea 为 加 速度 计 求 得 角度 


2. 二 阶 互补 滤波 
二 阶 互补 滤波 则 是 将 加 速度 信号 作为 参考 值 , 将 融合 计算 得 到 的 角度 与 加 速度 计算 
出 的 角度 的 偏差 量 加 入 积分 中 。 代 码 实现 如 下 : 


K= 0.5; 

float xl = (angleA - Com2 angle) * K * K; 

yl = yl + xl * dt; 

float x2 = yl + 2 * K *(angleA - Com2 angle) + omega; 
Com2 angle - Com2 angle * x2 * dt; 
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3.1 常用 通信 接口 协议 


3.1.1 SPI 


1. SPI 总 线 接口 概述 

串 行 外 设 接口 (Serial Peripheral Interface,SPI) 总 线 系统 是 一 种 同步 串 行 外 设 接口 ， 
是 Motorola 公司 首先 在 其 MC68HCXX 系列 处 理 器 上 定义 的 。SPI 接口 主要 应 用 于 
EEPROM Flash、 实 时 时 钟 .AD 转换 器 ,以 及 数字 信号 处 理 器 和 数字 信和 号 解码 器 之 间 , 人 允 
许 MCU 与 各 种 外 围 设备 以 串 行 方式 进行 通信 、 数 据 交换 中 , SPI 系统 可 直接 与 各 个 厂 
家 生产 的 多 种 标准 外 围 器 件 直接 相连 ,一 般 使 用 4 条 线 。 

(D 串 行 时 钟 线 SCLK。 其 主要 作用 是 主 设备 往 从 设备 传输 时 钟 信号 ,控制 数据 交换 
的 时 机 以 及 速率 。 

© 主机 输入 /从 机 输出 数据 线 MISO。 也 称 为 Rx 通道 ,作为 数据 的 入 口 ,主要 用 于 
SPI 设备 接收 数据 。 

© 主机 输出 /从 机 输入 数据 线 MOSI。 也 称 为 Tx 通道 ,作为 数据 的 出 口 ,主要 用 于 
SPI 设 备 发 送 数据 。 

@ 从 机 使 能 信号 nSS( 有 的 IC 会 标注 为 CS, 意 为 片 选 信号 ) 。 用 于 主 设备 片 选 从 设 
备 ,使 被 选中 的 从 设备 能 够 被 主 设备 所 访问 。 

SPI 接口 芯片 带 有 中 断 信号 线 INT 或 INT* ,有 的 SPI 接口 芯片 没有 主机 输出 /从 
机 输入 数据 线 MOSI。 所 以 ,SPI 系统 总 线 只 需 3 一 5 条 数据 线 和 控制 线 即 可 同 具 有 SPI 
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的 各 种 IO 器 件 连 接 。 

SPI 总 线 可 在 软件 的 控制 下 构成 各 种 简单 的 或 复杂 的 系统 。 例 如 ,一 个 主 MCU 和 
几 个 从 MCU; JLAM MCU 相互 连接 构成 多 主机 系统 (分 布 式 系统 ); 一 个 主 MCU 和 一 
个 或 几 个 从 1/O 设 备 。 大 多 数 情 况 下 ,使 用 一 个 MCU 作为 主机 ,控制 数据 向 一 个 或 多 个 
从 外 围 器 件 的 传送 ,从 器 件 只 能 在 主机 的 SCLK 信号 有 时 钟 跳 变 时 才能 传送 和 采集 
信号 。 


图 3.1.1 是 对 SPI 设 备 间 通 信 的 一 个 简单 的 描述 ,其 中 的 组 件 及 其 含义 如 下 。 


SDI 


- 
| SDO J 
- ——] SSPSR |— 


SSPBUF 
SCK 


a SS [Controller 从 设备 


主 设备 Controller| 


图 3.1.1 SPI 设 备 通信 结构 


(D SSPBUF(Synchronous Serial Port Buffer) , 泛 指 SPI 设备 里 面 的 内 部 缓冲 区 ,一 
般 在 物理 上 是 以 FIFO 的 形式 保存 传输 过 程 中 的 临时 数据 。 

@ SSPSR (Synchronous Serial Port Register) , 泛 指 SPI 设备 里 面 的 移 位 寄存 器 
(Shift Regitser) , 它 的 作用 是 根据 设置 好 的 数据 位 宽 (bitrwidth) 把 数据 移 人 或 者 移出 
SSPBUF, 

@ Controller, 泛 指 SPI 设 备 里 面 的 控制 寄存 器 ,可 以 通过 配置 它们 来 设置 SPI 总 线 
的 传输 模式 。 

SPI 典型 结构 组 成 如 图 3. 1. 2 所 示 。 

2. SPI 总 线 接 口 数据 传送 

SPI 是 一 个 环形 总 线 结构 ,其 时 序 简单 ,主要 是 在 SCLK 的 控制 下 ,两 个 双向 移 位 寄 
存 器 进行 数据 交换 ,其 时 序 结构 如 图 3. 1. 3 所 示 。 上 升 沿 发 送 数 据 , 下 降 沿 接收 数据 。 
其 数据 的 传输 格式 是 高 位 (MSB) 在 前 ,低位 (LSB) 在 后 。 上 升 沿 到 来 的 时 候 ,SDO 上 最 
高 位 的 电 平 将 被 发 送 到 从 设备 的 寄存 器 中 ; 下 降 沿 到 来 的 时 候 ,SDI 上 的 电 平 将 被 接收 
到 主 设备 的 寄存 器 中 。 一 个 完整 的 传送 周期 是 16 位 , 即 两 个 字 节 ,因为 ,首先 主机 要 发 
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SCLK SCLK 

MOSI = MOSI SPI 
SPI MISO |2——4 MISO 从 机 
主机 


SSI =| SS 

S82 

S83 
SCLK 
MOSI SPI 
MISO An 
SS 
SCLK 

L— -| MOSI SPI 

MISO 从 机 
SS 


图 3.1.2 SPI 总 线 结构 (1 主机 十 3 独立 从 机 ) 


送 命令 过 去 ,然后 从 机 根据 主机 的 命令 准备 数据 ,主机 在 下 一 个 8 位 时 钟 周期 才 把 数据 
读 回 来 。 


CPOL=0 
SCK — CPOI-1 
SS 

Cycle # 

CPHA-0 MISO Z 
MOSI 
Cycle # 

CPHA=1 MISO Z 


MOSI Z 


Æ 3.1.3 SPI 总 线 时 序 


SPI 模块 为 了 和 外 设 进 行 数据 交换 ,根据 外 设 工 作 要 求 ,其 输出 串 行 同步 时 钟 极 性 和 
相位 可 以 进行 配置 ,时 钟 极 性 (CPOL) 对 传输 协议 没有 大 的 影响 。 如 果 CPOL=0, 串 行 
同步 时 钟 的 空闲 状态 为 低 电 平 ; 如 果 CPOL=1, 串 行 同步 时 钟 的 空闲 状态 为 高 电 平 。 时 
钟 相 位 CCPHA) 能够 配置 用 于 选择 两 种 不 同 的 传输 协议 之 一 进行 数据 传输 。 如 果 
CPHA=0, 在 串 行 同步 时 钟 的 第 一 个 跳 变 沿 ( 上 升 或 下 降 ) 数 据 被 采样 ; 如 果 CPHA=1， 
在 串 行 同步 时 钟 的 第 二 个 跳 变 沿 ( 上 升 或 下 降 ) 数 据 被 采样 SPI 主 模 块 和 与 之 通信 的 外 
设 时 钟 相位 和 极 性 应 该 一 致 。 
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因此 根据 CPOL 和 CPHA 的 设置 ,SPI 共 可 分 为 4 种 模式 ,如 表 3.1.1 Bros. 


表 3.1.1 SPI4 种 模式 


SPI 模式 时 钟 极 性 (CPOL) 时 钟 相位 (CPHA) 
0 0 0 
1 0 1 
2 1 0 
3 1 1 


另 一 种 常用 的 模式 表示 方式 为 如 “(0,1)” 即 表明 CPOL—0.CPHA —1, 下 面 给 出 一 
段 用 软件 实现 SPI 串 行 通信 的 例 程 。 


int main(void) 
4 
SysCtlClockSet(SYSCTL SYSDIV 2 5 | SYSCTL USE PLL | SYSCTL OSC MAIN | SYSCTL XTAL 10MHZ); 
SysCtlPeripheralEnable(SYSCTL PERIPH SSI1); 
SysCtlPeripheralEnable(SYSCTL PERIPH GPIOF); 
SysCtlGPIOAHBEnable(GPIO PORTF BASE); // 挂 在 AHB 高 性 能 总 线 上 


GPIOPinConfigure(GPIO_PF2_SSI1CLK) ; 

GPIOPinConfigure(GPIO PF3 SSIIFSS); 

GPIOPinConfigure(GPIO PFl SSI1TX); 

GPIOPinTypeSSI(GPIO PORTF BASE,GPIO PIN 1|GPIO PIN 3|GPIO PIN 2); 

//SSI1_BRASE/ 时 钟 频率 /时 钟 协议 ,moto 代表 SPI 协议 /工作 模式 : 主机 模式 /位 速率 4M/ 数 据 
帧 位 数 16 

SSIConfigSetExpClk ( SSI1_ BASE, SysCtlClockGet ( ), SSI_FRF_MOTO_MODE_1, SSI_MODE_ 
MASTER, 16000000, 16); 

SSIEnable(SSI1 BASE); 

while(1)( 

SSIDataPut(SSI1 BASE, 0x2468); 

i 
} 


以 上 程序 能 够 实现 通过 SPI 接口 发 送 消息 ,在 使 用 SPI 发 送 消息 之 前 ,首先 要 对 SPI 
功能 进行 配置 ,这 也 是 以 上 程序 的 重点 所 在 ,SPI 初始 化 程序 设计 流程 框图 如 图 3. 1. 4 
所 示 。 
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启用 SSIO 模 块 


Y 
启用 GPIOF 


Y 
挂 载 GPIOF 至 


' 
设 定 PF1 . PF2. 
PF3 为 SSI 引 脚 

' 
设 定 SSI 时 钟 


了 
开启 SSI 


图 3.1.4 Tm4C 芯片 SPI 配置 流程 框图 


312 PC 


1. FC 总 线 接 口 概 述 

了 C(Inter-Integrated Circuit) 是 飞利浦 (Philips) 公 司 推出 的 一 种 高 性 能 芯片 间 串 行 
传输 总 线 ,与 SPI 不同, 它 仅 以 两 根 线 实现 了 完善 的 全 双 工 同步 数据 传送 ,可 以 极 方便 地 
构成 多 机 系统 和 外 围 器 件 扩展 系统 59 。 其 总 线 的 基本 结构 如 图 3. 1. 5 所 示 T C 总 线 采 
用 了 器 件 地 址 的 设置 方法 ,通过 软件 寻 址 完全 避免 了 器 件 的 片 选 寻 址 的 炊 端 ,从 而 使 硬 
件 系 统 具 有 更 简单 、 更 灵活 的 扩展 方法 。 


LE EE 


DAC 


uc ADC uC 
从 机 从 机 


| 主机 从 机 


图 3.1.5 FC 总线 的 基本 结构 
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EC 总 线 进行 数据 传输 时 只 需 两 根 信号 线 , 一 根 是 双向 的 数据 线 SDA, 另 一 根 是 时 
钟 线 SCL. MARR PC 总 线 上 的 设备 ,其 串 行 数据 都 连接 到 总 线 的 SDA 线 上 ,而 各 
设备 的 时 钟 线 均 接 到 总 线 的 SCL 线 上 。 

EC 总 线 是 一 个 多 主机 总 线 , 即 一 个 下 C 总 线 可 以 有 一 个 或 多 个 主机 ,总线 运 行 由 主 
机 控制 。 这 里 所 说 的 主机 是 指 启动 数据 的 传送 (发 起 始 信号 ) ,发 出 时 钟 信号 、 传 送 结束 
时 发 出 终止 信号 的 设备 。 通 常 ,主机 由 各 类 单片机 或 其 他 微 处 理 器 担当 。 被 主机 寻访 的 
设备 为 从 机 , 它 可 以 是 各 种 单片机 或 其 他 微 处 理 器 ,也 可 以 是 其 他 器 件 , 如 存储 器 .LED 
IÈ LCD 驱动 器 .A/D IÈ D/A 转换 器 .时 钟 日 历 器 件 等 。 

EC 总 线 为 双向 同步 串 行 总 线 , 因 此 fC 总 线 接口 内 部 为 双向 传输 电路 。 总 线 接口 
输出 为 开 漏 结构 ,所 以 总 线 上 必须 有 上 拉 电 阻 。 

为 了 进行 通信 ,每 个 连接 到 IC 总 线 上 的 设备 都 有 一 个 唯一 的 地 址 。 主 机 与 从 机 之 
间 的 数据 传送 可 以 是 由 主机 发 送 到 总 线 上 的 其 他 设备 ,这 时 主机 称 为 发 送 器 。 从 总 线 上 
接收 数据 的 设备 为 接收 器 。 

在 多 主机 系统 中 ,可 能 同时 有 几 个 主机 企图 启动 总 线 传送 数据 。 为 了 避免 混乱 , 保 
证 数据 的 可 靠 传送 ,任意 时 刻 总 线 只 能 由 某 一 台 主 机 控制 ,所 以 ,下 C 总 线 要 通过 总 线 裁 
决 ,来 决定 由 哪 一 台 主 机 控制 总 线 。 若 有 两 个 或 两 个 以 上 的 主机 企图 占用 总 线 , 一 旦 一 
个 主机 送 “1”, 而 另 一 个 或 多 个 送 “0”, 送 “1” 的 主机 退出 竞争 。 在 竞争 过 程 中 ,时 钟 信号 
是 各 个 主机 产生 异步 时 钟 信号 线 “ 与 ”的 结果 。 

EC 总 线 上 的 时 钟 总 是 对 应 于 主机 的 。 传 送 数据 时 ,每 个 主机 产生 自己 的 时 钟 , 主 机 
产生 的 时 钟 仅 在 慢 速 的 从 机 拉 宽 低 电 平 加 以 改变 或 在 竞争 中 失败 而 改变 。 

当 总 线 空闲 时 ,两 根 总 线 均 为 高 电 平 。 连 接 到 总 线 上 的 器 件 其 输出 级 必须 是 漏 极 或 
集 电 极 开路 ,任意 设备 输出 的 低 电 平 都 将 使 总 线 的 信号 变 低 , 即 各 设备 的 SDA 及 SCL 都 
是 线 与 的 关系 。 

2. FC 总 线 的 数据 传送 

1) 总 线 上 数据 的 有 效 性 

在 FC 总 线 上 ,每 一 位 数据 位 的 传送 都 与 时 钟 脉 冲 相 对 应 ,逻辑 “0 和 逻辑 “1 的 信和 号 
电 平 取决 于 相应 的 正 端 电源 Vop 的 电压 。EC 总 线 进行 数据 传送 时 ,在 时 钟 信号 为 高 电 
平 期 间 ,数据 线 上 必须 保持 有 稳定 的 逻辑 电 平 状态 ,高 电 平 为 数据 1, 低 电 平 为 数据 0。 
只 有 在 时 钟 线 低 电 平 期 间 , 才 允许 数据 线 上 的 电 平 状态 变化 ,如 图 3. 1.6 所 示 。 
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图 3.1.6 数据 位 的 有 效 性 规定 


2) 数据 传送 的 起 始 信号 和 终止 信号 
起 始 信号 和 终止 信号 如 图 3. 1.7 所 示 。 


图 3.1.7 起 始 信号 和 终止 信号 


根据 下 C 总 线 协 议 的 规定 : SCL 线 为 高 电 平 期 间 ,SDA 由 高 电 平 向 低 电 平 的 变化 
表示 起 始 信 号 ; SCL 线 为 高 电 平 期 间 , SDA 线 由 低 电 平 向 高 电 平 的 变化 表示 终止 
信号 。 

起 始 信号 和 终止 信号 都 是 由 主机 发 出 的 ,在 起 始 信号 产生 后 ,总 线 就 处 于 被 占用 的 
状态 ; 在 终止 信号 产生 一 定时 间 后 ,总 线 就 处 于 空闲 状态 。 连 接 到 下 C 总 线 上 的 设备 若 
RA PC 硬件 接口 , 则 很 容易 检测 到 起 始 信号 和 终止 信号 。 对 于 不 具备 PC 总 线 接口 的 
MCU 来 说 ,为 了 能 准确 检测 起 始 信号 和 终止 信号 ,必须 保证 在 总 线 的 一 个 时 钟 周期 内 对 
数据 线 至 少 采 样 两 次 。 

从 机 收 到 一 个 完整 的 数据 字 节 后 ,有 可 能 需要 完成 一 些 其 他 工作 ,如 处 理 内 部 中 断 
服务 等 ,可 能 使 它 无 法 立刻 接收 下 一 个 字 节 。 这 时 从 机 可 以 将 SCL 线 拉 成 低 电 平 , 从 而 
使 主机 处 于 等 待 状态 ,直到 从 机 准备 好 可 以 接收 下 一 个 字 节 时 ,再 释放 SCL 线 使 之 为 高 
电 平 ,数据 传送 继续 进行 。 

3) 数据 传送 格式 

(1) 字 节 传送 与 应 答 

I HI PC 总 线 进行 数据 传送 时 ,对 传送 的 字 节 数 是 没有 限制 的 ,但 是 每 一 个 字 节 必须 
保证 是 8 位 长 度 ,并 且 首 先 发 送 的 数据 位 为 最 高 位 ,每 传送 一 个 字 节 数据 后 都 必须 跟随 
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一 位 应 答 信号 ,与 应 答 信 号 相对 应 的 时 钟 由 主机 产生 ,主机 必须 在 这 一 时 钟 位 上 释放 数 
据 线 ,使 其 处 于 高 电 平 状态 ,以 便 从 机 在 这 一 位 上 送出 应 答 信 号 ,如 图 3. 1.8 所 示 。 


E t 
起 始 条 件 应 答 时 钟 脉冲 
图 3.1.8 FC 总线 应 答 时 序 


0 从 机 输出 低 电 平 为 应 答 信号 ,表示 继续 接收 , 若 

从 机 输出 高 电 平 则 为 非 应 答 信 号 ,表示 结束 接收 。 由 于 某 种 原因 ,从 机 不 对 主机 寻 址 
信和 号 应 答 时 (如 从 机 正在 进行 实时 性 的 处 理工 作 而 无 法 处 理 接 收 总 线 上 的 数据 ), 它 必 
须 释放 总 线 ,将 数据 线 置 于 高 电 平 ,然后 由 主机 产生 一 个 终止 信号 以 结束 总 线 的 数据 
传送 。 

如 果 从 机 对 主机 进行 了 应 答 ,但 在 数据 传送 一 段 时 间 后 无 法 继续 接收 更 多 的 数据 
时 ,从 机 可 以 通过 发 送 非 应 答 信 号 通知 主机 ,主机 则 应 发 出 终止 信号 来 结束 数据 的 继续 
传送 。 

当主 机 接收 数据 时 , 它 收 到 最 后 一 个 数据 字 节 后 ,必须 向 从 机 发 送 一 个 非 应 答 信号 ， 
使 从 机 释放 SDA 线 , 以 便 主机 产生 终止 信号 ,从 而 停止 数据 传送 。 

(2) 数据 传送 格式 

EC 总 线 上 传输 的 数据 信号 是 广义 的 , 既 包 括 地 址 信号 ,又 包括 真正 的 数据 信号 
EC 总 线 数据 传送 时 必须 遵守 规定 的 数据 传送 格式 ,如 图 3. 1. 9 所 示 。 

按照 总 线 规约 ,起 始 信 号 表明 一 次 数据 传送 的 开始 ,其 后 为 寻 址 字 节 , 寻 址 字 节 由 高 
7 位 地 址 和 最 低 1 位 方向 位 组 成 ,高 7 位 地 址 是 被 寻 址 的 从 机 地 址 ,方向 位 是 表示 主机 与 
从 机 之 间 的 数据 传送 方向 ,方向 位 为 “0” 时 表示 主机 发 送 数 据 “ 写 ”, 方 向 位 为 “1” 时 表示 
主机 接收 数据 “ 读 ”。 在 寻 址 字 节 后 是 将 要 传送 的 数据 字 节 与 应 答 位 ,在 数据 传送 完 后 主 
机 必须 发 送 终 止 信号 。 但 是 ,如 果 主 机 和 希望 继续 占用 总 线 进行 新 的 数据 传送 , 则 可 以 不 
产生 终止 信号 ,马上 再 次 发 出 起 始 信号 对 另 一 从 机 进行 寻 址 。 
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图 3.1.9 FC 总 线 一 次 完整 的 数据 传输 格式 
因此 ,在 总 线 的 一 次 数据 传送 过 程 中 ,可 以 有 几 种 读 、 写 组 合 方式 。 
CD. 主机 向 从 机 发 送 n 个 数据 ,数据 传送 方向 在 整个 传送 过 程 中 不 变 , 如 图 3. 1. 10 
所 示 。 


E K; SLAVE KRESS ww AL DATA] A A 7 A/A PS 


”数据 传输 。 一 一 
“0"( 写 入 ) (Cox 字 节 + 应 答 信号 


E 从 主机 到 从 机 
A= 应 答 信号 (SDA 低 电 平 ) 

口 从 从 机 到 主机 A= 无 应 答 信号 (SDA 高 电 平 ) 
S= 开始 条 件 

P= 终止 条 件 


图 3.1.10 FC 数据 传输 方式 1 


主机 在 第 一 个 字 节 后 ,立即 由 从 机 读数 据 , 在 整个 过 程 中 , 除 寻 址 字 节 外 ,都 是 从 机 
发 送 .主机 接收 ,如 图 3.1. 11 所 示 。 


1 

TT T. 77 7717777 

LS A SAVE ADDRESS RWA A | DATA ^ DATA L^ A 
一 一 一 数据 传输 | 


( 读 取 ) (n 字 节 + 应 答 信号 ) 


图 3.1.11 EC 数据 传输 方式 2 


© 在 传送 过 程 中 , 当 需 要 改变 传送 方向 时 ,起 始 信号 和 从 机 地 址 都 被 重复 产生 一 次 ， 
但 两 次 读 / 写 方向 位 正好 反 相 ,如 图 3.1.12 所 示 。 
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7 S/[ SLAVE ADDRESS FRIW] A | DATA| A/A STSUNE ADDRESS TUS] ^ DATA| A/A [P 
| Less ] er 
应 答 )* 一 + 应 答 )* 一 
"—- + 应 答 ) | + 应 答 ) 
#5 传输 方向 在 这 
一 点 可 能 改变 
* 由 于 数据 与 应 答 位 的 传输 方向 


取决 于 R/W 位 ， 因 此 不 加 阴影 
图 3.1.12 FC 数据 传输 方式 3 


由 以 上 格式 可 见 ,无 论 采 用 哪 种 方式 ,起 始 信和 号、 终止 信号 和 地 址 均 由 主机 发 送 , 数 
据 字 节 的 传送 方向 由 寻 址 字 节 中 方向 位 规定 ; 每 个 字 节 的 传送 都 必须 有 应 答 信号 位 
相 随 。 

4) FC 总 线 的 寻 址 约定 

FC 总 线 是 多 主 总 线 , 总 线 上 的 各 个 主机 都 可 以 争 用 总 线 ,在 竞争 中 获胜 者 马上 占有 
总 线 控制 权 。EC 总 线 协 议 对 有 权 使 用 总 线 的 主机 寻 址 做 出 了 明确 的 规定 : 采用 7 位 的 
寻 址 字 节 , 寻 址 字 节 是 起 始 信号 后 的 第 一 个 字 节 。 

(1) 寻 址 字 节 的 位 定义 

从 高 到 低 分 别 为 7 位 数据 ,最 低位 LSB 为 数据 传送 方向 位 ,如 图 3. 1. 13 所 示 。 主 机 
发 送 地 址 时 ,总线 上 的 每 个 从 机 都 将 这 7 位 地 址 码 与 自己 的 期 间 地 址 进行 比较 ,如 果 相 
同 则 认为 自己 正 被 主机 寻 址 ,根据 读 / 写 位 将 自己 确定 为 接收 器 或 发 送 器 。 


MSB LSB 
T T T T T T = 
R/W 


slave address 


R 3.1.13 寻 址 字 节 


从 机 的 地 址 是 由 一 个 固定 部 分 和 一 个 可 编程 部 分 组 成 。 固 定 部 分 为 器 件 的 编号 地 
址 ,表明 了 器 件 的 类 型 ,出厂 时 是 固定 的 ,不 可 更 改 ; 可 编程 部 分 为 器 件 的 呼叫 地 址 , 视 硬 
件 接线 而 定 , 引 脚 地 址 数 决定 了 同一 种 器 件 可 接 人 到 PC 总 线 中 的 最 大 数目 。 如 果 从 机 
为 单片机 , 则 7 位 地 址 为 纯 软 件 地 址 。 

(2) 寻 址 字 节 中 的 特殊 地 址 

EC 总 线 地 址 统一 由 卫 C 总 线 委员 会 实行 分 配 , 其 中 两 组 编号 地 址 0000 和 1111 已 
被 保留 , 留 作 特殊 用 途 , 如 表 3. 1.2 所 示 。 
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表 3.1.2 PC 总 线 特 殊 地 址 


地 址 位 读 / 写 位 用 途 
0000 000 0 通用 广播 地 址 
0000 000 1 起 始 地 址 
0000 001 x CBUS 地 址 
0000 010 x 
0000 011 x 

待定 
0000 1X X X 
1111 1X X x 
1111 0X X x 10 位 从 机 地 址 


CD 广播 地 址 。 起 始 信号 之 后 第 一 个 字 节 为 “0000 0000" 时 称 为 通用 广播 地 址 。 广 播 
地 址 用 于 寻访 接 到 PC 总 线 上 的 所 有 器 件 ,并 向 它们 广播 数据 。 

@ 起 始 字 节 是 提供 给 没有 下 C 总 线 接口 的 单片机 查询 FC 总 线 时 使 用 的 特殊 字 节 。 
对 于 不 具备 IPC 总 线 接口 的 单片机 ,采用 软件 模拟 时 序 的 方法 ,也 可 以 接 入 FC 总 线 

下 面 给 出 在 本 系统 采用 Ti 飞行 控制 板 芯片 的 开发 板 TIVA C Launchpad 上 实现 
PC 主 从 模块 消息 互通 的 主 模块 程序 设计 流程 图 (如 图 3. 1. 14 所 示 )。 从 模块 程序 设计 
与 主 模块 类 似 , 但 不 用 设置 时 钟 频 率 等 。 


3.1.3 USART 


1. USART 功能 概述 


USART( Universal Synchronous/ Asynchronous Receiver/Transmitter) 是 一 个 全 双 
工 通用 同步 /异步 串 行 收发 模块 ,该 接口 是 一 个 高 度 灵活 的 串 行 通信 设备 。 与 UART 相 
比 , 它 增加 了 同步 功能 ,能 够 提供 主动 时 钟 来 实现 同步 通信 。 它 提供 了 一 种 灵活 的 方法 
与 使 用 工业 标准 NRZ 异步 串 行 数 据 格式 的 外 部 设备 之 间 进 行 全 双 工 数据 交换 。 
USART 利用 分 数 波 特 率 发 生 器 提供 宽 范 围 的 波 特 率 选择 。 它 支持 同步 单 向 通信 和 半 双 
工 单线 通信 。 它 还 允许 多 处 理 器 通信 。 

接口 通过 3 个 引 脚 与 其 他 设备 连接 在 一 起 ,任何 USART 双向 通信 至 少 需要 两 个 
脚 , 即 接收 数据 输入 (RX) 和 发 送 数据 输出 (TX)。USART 通信 和 具有 以 下 特性 。 
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使 能 PC 模块 


i 


配置 引 脚 PC 功能 


i 


设 定 为 PC 主 模块 


Y 
设 定 PC 时 钟 频率 


— — 
设 定 主 模块 要 放 在 总 
线 上 的 从 模块 地 址 


向 从 模块 发 送 数据 


等 待 ACK 信 号 


i 


从 从 模块 读 取 数 据 


图 3.1.14 FC 主 模块 程序 设计 流程 框图 


CD 总 线 在 发 送 或 接收 前 应 处 于 空闲 状态 。 

@ 一 个 起 始 位 。 

@ 一 个 数据 字 (8 位 或 9 位 ) ,最 低 有 效 位 在 前 。 

@ 0. 5,1. 5 这 两 个 的 停止 位 ,由 此 表明 数据 帧 的 结束 。 

C) 使 用 分 数 波 特 率 发 生 器 一 一 12 位 整数 和 4 位 小 数 的 表示 方法 。 
一 个 状态 寄存 器 (USART_SR)。 

CO 一 个 数据 寄存 器 (USART_DR)。 

一 个 波 特 率 寄存 器 (USART_BRR) .12 位 整数 和 4 位 小 数 。 

© 一 个 智能 卡 模式 下 的 保护 时 间 寄 存 器 (USART_GTPR)。 

2. USART 数据 传输 


如 图 3. 1. 15 所 示 , 字 长 可 以 通过 编程 USART. CRI 寄存 器 中 的 M 位 ,选择 成 8 位 
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或 9 位。 在 起 始 位 期 间 ,Tx 脚 处 于 低 电 平 ,在 停止 位 期 间 Tx 脚 处 于 高 电 平 。 空 闲 符号 
被 视 为 完全 由 “1? 组 成 的 一 个 完整 的 数据 帧 ,后 面 跟着 包含 了 数据 的 下 一 帧 的 开始 位 
(1 的 位 数 也 包括 了 停止 位 的 位 数 ) 。 


8 位 字 长 (未 设置 M 位 ) — 下 一 个 数据 由 
数据 帧 校 验 位 下 个 
起 始 起 始 
位 位 


**LBCL 位 控制 最 后 一 个 数据 的 时 钟 脉冲 


(a) 1 个 停止 位 


下 一 个 数据 帧 
数据 帧 TA 


1/2 个 停止 位 


(b) 2 个 停止 位 


T 下 一 个 数据 由 
数据 由 bris "i 


(c) 2 个 停止 位 


的 奇 个 下 一 个 数据 由 
数据 由 E a : 


t se To [ez o [es se] e [o] 


1/2 个 停止 位 
(d) 12 个 停止 位 
图 3.1.15 USART 的 数据 帧 格式 
断 开 符 号 被 视 为 在 一 个 帧 周期 内 全 部 收 到 “0*( 包 括 停 止 位 期 间 , 也 是 *0”)。 在 
断 开 帧 结束 时 ,发 送 器 再 插入 一 或 两 个 停止 位 (“1”) 来 应 答 起 始 位 。 发 送 和 接收 由 
一 共用 的 波 特 率 发 生 器 驱动 , 当 发 送 器 和 接收 器 的 使 能 位 置 位 时 ,分 别 为 其 产生 
DIM 


X TIVA C Launchpad 上 进行 UART 串口 通信 的 程序 设计 流程 框图 如 图 3. 1. 16 
所 示 。 
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使 能 UARTO 
模块 


配置 引 脚 
UART 功 能 


1 


设置 串口 参数 


i 


使 能 串口 接收 
中 断 


| 3 


使 能 串口 发 生 串 口 
接收 中 断 "pier 
Y 
清除 中 断 
KE 
Y 
从 串口 FIFO 
读 出 数据 


图 3.1.16 串口 通信 程序 设计 流程 框图 


3.2 常用 RC(Radio Controller) 通 信 协 议 


3.2.1 PPM 


PPM(Pulse Position Modulation , 脉 宽 位 置 调制 ) 调 制 信号 控制 脉冲 序列 中 各 脉冲 
的 相对 位 置 ( 即 相位 ) ,使 各 脉冲 的 相对 位 置 随 调制 信号 变化 。 此 时 序列 中 脉冲 幅度 和 宽 
度 均 不 变 。PPM 是 遥控 模型 中 比较 通用 的 一 种 信号 格式 ,是 接收 机 收 到 遥控 器 发 出 的 4 
通道 信息 后 ,输出 给 飞行 控制 模块 的 编码 信号 ,飞行 控制 部 分 对 其 进行 解码 即 可 得 到 各 
个 通道 的 控制 量 。 

PPM 原理 是 通过 检测 给 定 频率 的 PWM 信号 的 占 空 比 来 获取 指令 信号 的 。 如 
图 3. 2. 1 所 示 , 信 号 频率 为 50Hz, 一 个 周期 为 20ms, 每 个 信号 脉 宽 0~2ms; 1 Wi PPM 
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信号 长 度 为 20ms, 实 际 遥 控 最 多 可 以 容纳 9 个 通道 。 一 个 通道 的 2ms 时 间 内 , 脉 宽 仅 在 
1 一 2ms 内 变化 , 即 脉 宽 lms 表示 停 转 , 脉 宽 2ms 表示 满 量程 运作 ,其 间 各 点 按 比 例 换算 ， 
如 脉 宽 1. 5ms 表示 50% 的 量程 。 

PPM 信号 波形 如 图 3. 2. 1 所 示 。 


周期 : 20ms 


1 1 1 1 
lh 1 


图 3.2.1 PPM 信号 图 解 


3.2.2 PWM 


PWMc(Pulse Width Modulation ,脉冲 宽度 调制 ) 是 利用 微 处 理 器 的 数字 输出 来 对 模 


拟 电路 进行 控制 的 一 种 非常 有 效 的 技术 ,一 般 变换 后 10% 
Moret JS o (E cred s eS — [ [ | X 
小 而 改变 ,如 图 3. 2. 2 所 示 。PWM 被 广泛 应 用 在 从 3096 ue 
测量 .通信 到 功率 控制 与 变换 的 许多 领域 中 。 | | | l | l 
在 模拟 电路 中 ,模拟 信号 的 值 可 以 连续 进行 变 uli: 


5v 
化 ,在 时 间 和 值 的 幅度 上 几乎 没有 限制 ,基本 上 可 以 ] I ll ov 


取 任 何 实数 值 , 输 入 与 输出 也 呈 线 性 变化 。 所 以 在 模 ”图 3.2.2? 不 同 占 空 比 的 PWM 波 
拟 电 路 中 ,电压 和 电流 可 直接 用 来 进行 控制 对 象 ,如 

家 用 电器 设备 中 的 音量 开关 控制 .采用 亢 素 灯泡 灯具 的 亮度 控制 等 。 但 模拟 电路 有 诸多 
的 问题 : 例如 ,控制 信号 容易 随时 间 漂 移 , 难 以 调节 ; 功 耗 大 ; 易 受 噪声 和 环境 干扰 等 。 
与 模拟 电路 不 同 ,数字 电路 是 在 预先 确定 的 范围 内 取 值 ,在 任何 时 刻 其 输出 只 可 能 为 ON 
和 OFF 两 种 状态 ,所 以 电压 或 电流 会 以 通 / 断 方式 的 重复 脉冲 序列 加 载 到 模拟 负载 。 
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PWM 技术 是 一 种 对 模拟 信号 电 平 的 数字 编码 方法 ,通过 使 用 高 分 辩 率 计数 器 (调制 频 
率 ) 调 制 方 波 的 占 空 比 , 从 而 实现 对 一 个 模拟 信号 的 电 平 进行 编码 。 其 最 大 的 优点 是 从 
处 理 器 到 被 控 对 象 之 间 的 所 有 信号 都 是 数字 形式 的 ,不 需要 再 进行 数 模 转换 过 程 ; 而 且 
对 噪声 的 抗 干扰 能 力也 大 大 增强 (噪声 只 有 在 强 到 足以 将 逻辑 值 改变 时 , 才 有 可 能 对 数 
字 信 号 产生 实质 的 影响 ) ,这 也 是 PWM 在 通信 等 信号 传输 


使 能 PWM 
行业 得 到 大 量 应 用 的 主要 原因 。 模块 
模拟 信号 能 否 使 用 PWM 进行 编码 调制 , 仅 依赖 带宽 ， mm 
这 即 意味 着 只 要 有 足够 的 带宽 ,任何 模拟 信号 值 均 可 以 采 PWM 功能 
用 PWM 技术 进行 调制 编码 ,一 般 而 言 ,负载 需要 的 调制 频 i 
率 要 高 于 10Hz, 在 实际 应 用 中 ,频率 在 1— 200kHz 之 间 。 设置 PWM 波 通才 
在 信号 接收 端 , 需 将 信号 解 调 还 原 为 模拟 信号 ,目前 在 E EE 
很 多 微型 处 理 器 内 部 都 包含 有 PWM 控制 器 模块 。 V RR EA 
PWM 控制 技术 以 其 控制 简单 .灵活 和 动态 响应 好 的 优 i 


设置 PWM 波 分 频 
点 而 成 为 电力 电子 技术 最 广泛 应 用 的 控制 方式 ,也 是 人 们 系数 


研究 的 热点 。 由 于 当今 科学 技术 的 发 展 已 经 没有 了 学 科 之 1 


间 的 界限 ,结合 现代 控制 理论 思想 或 实现 无 谐振 波 开关 技 BERI STRE 
术 将 会 成 为 PWM 控制 技术 发 展 的 主要 方向 之 一 。 其 根据 
相应 载荷 的 变化 调制 晶体 管 基 极 或 MOS 管 栅 极 的 偏 置 , 来 "EET 
实现 晶体 管 或 MOS 管 导 通 时 间 的 改变 ,从 而 实现 开关 稳 压 

电源 输出 的 改变 。 这 种 方式 能 使 电源 的 输出 电压 在 工作 条 使 能 PWM 发 生 器 
件 变化 时 保持 恒定 ,是 利用 微 处 理 器 的 数字 信号 对 模拟 电 1 

路 进行 控制 的 一 种 非常 有 效 的 技术 。 使 能 PWM 输出 


对 于 具有 PWM 模块 的 芯片 ,可 以 方便 地 通过 硬件 方 
式 输出 PWM 波 。 下 面 给 出 配置 PWM 功能 的 程序 设计 流 
程 框图 (如 图 3. 2. 3 所 示 ) 。 


图 3.2.3 PWM 功能 配置 
流程 框图 


四 旋翼 飞行 器 硬件 系统 设计 


4.1 ”四 旋翼 飞行 器 系统 硬件 总 体 结构 


这 里 研发 四 旋 导 飞行 器 系统 的 硬件 主要 由 地 面 控制 板 和 飞行 控制 板 两 部 分 组 成 。 
PC 上 位 机 和 遥控 器 的 控制 信号 经 地 面 控制 板 处 理 后 ,再 通过 nRF 无 线 模块 与 飞行 控制 
板 进行 无 线 通信 。 

其 硬件 结构 框图 如 图 4. 1. 1 所 示 。 
m RH uiti OLEDE 
ma F--- gue. [— | ees [— | um 
|| 


NRF 无 | 00 NL 
线 模块 模块 


光 流传 li 

飞行 MPU6050 
控制 板 六 轴 传 感 器 
超声 波 


传感器 | | | } 


18 2 号 ag | [45 
CUM, 电机 | | 电机 


图 4.1.1 四 旋 辟 飞行 器 系统 硬件 结构 框图 
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Vujig3 7c A DLE Vy ün e] 4. 1. 2 所 示 。 


图 4.1.2 四 旋翼 飞行 器 实物 


4.1.1 主 控 板 


飞行 控制 板 的 主要 功能 有 如 下 几 个 。 

CD 通过 电机 驱动 程序 调整 飞行 控制 板 输出 四 路 PWM 波 的 占 空 比 , 从 而 改变 4 个 电 
机 的 转速 来 实现 对 四 旋翼 飞行 器 运动 状态 的 控制 。 

@ 飞行 器 传感器 数据 采集 及 处 理 , 包 括 六 轴 传 感 器 的 姿态 数据 ,超声 波 模块 测量 的 
高 度数 据 、 光 流传 感 器 的 位 移 数据 。 

© 与 地 面 控制 板 的 交互 通信 ,接收 地 面 控制 站 发 送 来 的 遥控 器 数据 以 及 其 他 控制 命 
令 , 同 时 向 地 面 站 反馈 自身 各 项 状态 数据 。 

地 面 控制 板 (如 图 4. 1. 3 所 示 ) 的 主要 功能 如 下 。 

(D 实时 采集 遥控 器 数据 ,采集 遥控 器 的 PPM 信号 并 解析 成 真正 的 遥控 数据 ,实现 遥 
控 器 对 四 旋 汉 飞行 器 的 控制 。 

Q 实现 与 飞行 控制 板 之 间 的 交互 通信 ,包括 传送 遥控 数据 和 控制 命令 数据 ,接收 飞 
行 器 的 状态 数据 ,如 超声 波 传送 的 高 度数 据 。 

@ 在 LED 屏幕 上 动态 显示 飞行 器 的 飞行 状态 数据 。 

飞机 与 地 面 站 之 间 能 够 通过 nRF 进行 无 线 通 信 , 上 位 机 与 地 面 站 之 间 通 过 USB 数 
据 线 建立 有 线 通 信 。 另 外 ,还 可 以 通过 遥控 器 对 飞机 进行 控制 。 
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图 4.1.3 地 面 控制 板 实物 


1. 微 处 理 器 模块 

飞行 控制 板 主 芯片 采用 了 美国 得 州 仪器 公司 Tiva 系列 的 TM4C123G 微 控 制 器 ,其 
内 核 采用 了 32 位 的 ARM Cortex-M4 下 内 核 , 最 高 可 支持 的 主 频 为 80MHz,256KB 内 部 
闪存 .32KB SRAM .多 种 串口 通信 。 其 结构 框图 如 图 4.1.4 所 示 。 

飞行 控制 板 ( 如 图 4. 1. 5 所 示 ) 通 过 电机 了 驱动 程序 调整 飞行 控制 板 上 输出 的 四 路 
PWM 波 占 空 比 , 以 调节 4 个 电机 转速 ,实现 对 四 旋 避 飞行 器 运动 状态 的 控制 ; 连接 超声 
波 、 光 流 、 六 轴 传 感 器 获取 姿态 信息 ,在 飞行 控制 板 上 实时 运行 各 种 算法 ,对 飞行 器 进行 
高 度 控制 ,位 姿 调 节 等 稳定 控制 ,并 与 上 位 机 、 地 面 站 建立 实时 的 交互 数据 通信 和 链 路 , 实 
现 四 旋 滤 飞行 器 的 定 高 . 悬 停 以 及 完成 各 种 飞行 动作 指令 。 

地 面 控制 板 采用 了 意 法 半导体 集团 开发 的 STM32 微 处 理 器 ,STM32 基于 ARM 
Cortex-M3 内 核 ,有 着 极 高 的 性 价 比 、 多 样 化 的 产品 线 、 简 易 的 开发 方式 等 优点 。 按 性 能 
分 成 两 个 不 同 的 系列 , 即 STM32F103”* 增 强 型 ?系列 和 STM32F101“ 基 本 型 "系列 。 增 强 
型 系列 时 钟 频率 达到 72MHz, 是 同类 产品 中 性 能 最 高 的 产品 ; 基本 型 时 钟 频率 为 
36MHz. UA 16 位 产品 的 价格 得 到 比 16 位 产品 大 幅 提升 的 性 能 ,是 16 位 产品 用 户 的 最 佳 
选择 。 两 个 系列 都 内 置 32KB 到 128KB 的 闪存 ,不 同 的 是 SRAM 的 容量 和 外 设 接口 的 
组 合 。 时 钟 频率 为 72MHz 时 ,从 闪存 执行 代码 , STM32 功 耗 36mA, 是 32 位 市 场 上 功 
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JTAGISWD 


BoolLoader 


DriverLib 


AES & CRC 
系统 控制 
和 时 钟 
(wj Precis. Osc.) 


USBOTG [^———S 


[8 4.1.4 Tiva TM4C123G H6PM 微 处 理 器 结构 框图 
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UART O 


光 流 传感器 


超声 波 NRF 无 线 通信 电 调 驱动 


图 4.1.5 飞行 控制 板 实物 


耗 最低 的 产品 ,相当 于 0. 5mA/MHz。STM32 是 基于 固件 库 的 开发 方式 ,只 需要 调用 应 
用 程序 接口 API 而 不 需要 直接 对 底层 寄存 器 操作 就 可 以 完成 应 用 程序 的 开发 ,从 而 缩短 
了 程序 开发 周期 。STM32F103 增强 型 单片机 有 以 下 性 能 。 

(D 内 核 : ARM32 位 Cortex-M3 CPU, 最 高 工作 频率 72MHz,1. 25DMIPS/MHz。 
单 周 期 乘法 和 硬件 除法 。 

© 存储 器 : 片上 集成 32 一 512KB 的 Flash 存储 器 以 及 6 一 64KB 的 SRAM 存储 器 。 

© 时 钟 , 复 位 和 电源 管理 : 2.0 一 3. 6V 的 电源 供电 和 1/O 接口 的 驱动 电压 ,POR、 
PDR 和 可 编程 的 电压 探测 器 (PVD) ,4 一 16MHz 的 晶振 ,内 艇 出 厂 前 调 校 的 8MHz RC 
振荡 电路 。 内 部 40kHz 的 RC 振荡 电路 。 用 于 CPU 时 钟 的 PLL。 带 校准 用 于 RTC 的 
32kHz 的 晶振 。 

@ 低 功 耗 : 3 种 低 功 耗 模式 , 即 休眠 、 停 止 . 待 机 模式 ,为 RTC 和 备份 寄存 器 供电 的 
VBAT。 

© 调试 模式 : 串 行 调试 CSWD) 和 JTAG 接口 。 

( 最 多 高 达 112 个 的 快速 IO 端口 : 根据 型 号 的 不 同 ,有 26、37、51、80 和 112 的 
1/0 端口 ,所 有 的 端口 都 可 以 映射 到 16 个 外 部 中 断 向 量 。 除 了 模拟 输入 ,所 有 的 都 可 以 
接收 5V 以 内 的 输入 。 最 多 达 11 个 定时 器 : 4 个 16 位 定时 器 ,每 个 定时 器 有 4 个 IC/ 
OC/PWM 或 者 脉冲 计数 器 ; 2 个 16 位 的 6 通道 高 级 控制 定时 器 ,最 多 6 个 通道 可 用 于 
PWM 输出 ; 2 个 看 门 狗 定时 器 (独立 看 门 狗 和 窗口 看 门 狗 ); Systick 定时 器 ,24 位 倒 计 
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数 器 ; 2 个 16 位 基本 定时 器 ,用 于 驱动 DAC。 最 多 达 13 个 通信 接口 : 2 个 IIC 接口 
(SMBus/PMBus) ; 5 个 USART 接口 (ISO7816 接口 ,LIN,IrDA 兼容 ,调试 控制 ); 3 个 
SPI 接口 (18Mbit/s),2 个 和 IIS 复 用 ; CAN 接口 (2. 0B); USB 2. 0 全 速 接口 ; SDIO 
HH. 

@ ECOPACK 封装 : STM32F103xx 系列 微 控制 器 采用 ECOPACK 封装 形式 。 

以 STM32F103RBT 为 例 ,STM32F103RBT6 单片机 核心 板 电 路 主要 包括 电源 滤波 
电路 .晶振 电路 .复位 电路 和 启动 配置 电路 ,在 层次 原理 图 中 产生 的 子 模块 的 原理 图 文件 
中 完成 这 些 功能 电路 的 绘制 ,绘制 好 的 电路 如 图 4. 1.6 所 示 。 


图 4.1.6 STM32F103RBT6 单片机 核心 板 电路 


为 了 保证 单片机 工作 时 要 求 的 稳定 电压 ,电路 中 最 好 要 有 电源 滤波 电路 ,本 设计 里 
用 了 数 个 0. lwF 的 电容 作为 滤波 电容 ,对 于 单片机 需要 接 电 源 的 端口 需要 注意 以 下 
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两 点 。 

(D 无论 是 否 使 用 模拟 部 分 和 AD 部 分 , MCU 外 围 为 VCC, GND, VDDA, VSSA, 
Vref( 如 果 封 装 有 该 引 脚 ) 都 必须 连接 ,不 可 悬空 。 

@ 对 于 每 组 对 应 的 Voc 8l GND 都 应 至 少 放置 一 个 0. lpF 的 陶瓷 电容 用 于 滤波 ,并 
且 该 电容 放置 应 尽量 靠近 MCU, 

由 于 单片机 所 接 的 外 设 很 多 ,所 以 必须 合理 分 配 引 脚 功能 ,以 便 充 分 利用 单片机 的 
内 部 资源 ,STM32 系列 单片机 制造 商 意 法 半导体 为 此 开发 了 一 个 软件 MicroXplorer, 使 
用 这 个 工具 能 很 直观 地 对 端口 进行 分 配 ,分 配 好 的 IO 资源 如 图 4. 1.7 所 示 。 


© 
z 


SYS JTDO-TRACES 


SYS JTCK-SWCLK 


SYS JTRST 
SYS JTDI 


SYS OSC32 IN 
SYS OSC32 OUT 
SYS OSC IN 
SYS OSC OUT 


SYS JTMS-SWDIO 


USARTI RX 
USARTI TX 


ZU sp2 MOSI 
T] sPI2 MISO 
SPI2 SCK 
SPI2 NSS 


图 4.1.7. STM32FI03RBT6 端口 分 配 


2. 飞行 姿态 感 测 模块 
陀螺 仪 是 测定 物体 旋转 角度 的 传感器 ,能 测定 整个 飞行 器 的 姿态 。 最 早 的 陀螺 仪 是 
机 械 式 的 ,近年 来 随 着 MEMS( 微 机 电 ) 技 术 的 发 展 ,陀螺 仪 已 经 做 得 很 小 , 且 可 支持 下 C、 
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SPI 等 总 线 ,大 大 方便 了 数据 的 读 取 和 PCB 设计 ,以 下 介绍 Invensense 公司 生产 的 一 款 


MPU6050 陀螺 仪 。 


MPU-6050 是 一 个 只 有 4mmX4mmX 0. 9mm 的 六 轴 运 动 处 理 传感器 (如 图 4.1.8 
所 示 ) ,以 数字 输出 六 轴 的 旋转 矩阵 、 欧 拉 角 格式 .四 元 数 的 融合 演算 数据 ,集成 了 3 轴 
MEMS 陀螺 仪 .3 fili MEMS 加 速度 计 、1 个 可 以 扩展 的 数字 运动 处 理 器 (Digital Motion 
Processor, DMP), DMP 有 权 使 用 MPU 的 一 个 外 部 引 脚 产生 中 断 , 可 用 了 下 C 接口 连接 
一 个 第 三 方 的 数字 传感器 (如 磁力 计 )。 扩 展 之 后 , 它 可 以 利用 下 C 或 SPI 接口 输出 一 个 


9 轴 的 信和 号。 
顶 视 

g 8 s 

828828 

ezee] 
con [Calow 
NC| 2 E Nc 
NM 3 INC. 
nefa) [ve 


LER og 
aux paf e [fve 
7|[s]|s][e 1 
E228: 
ERE 
QFN Package. 
24pin, Amm x Amm x 09mm. 


量 转化 成 数字 量 输出 。 其 引 脚 配置 如 表 4.1.1 所 示 。 用 户 可 以 控制 传感器 的 测量 范围 ， 


其 中 陀螺 仪 性 能 参数 如 下 。 


OFN Package. 
24pin Amm rmmxosmm 


图 4.1.8 MPU-6050 


MPU-6050 对 加 速度 计 和 陀螺 仪 分 别 采 用 3 个 16 位 的 ADC 模块 ,将 测量 出 的 模拟 


表 4.1.1 MPU6050 引 脚 说 明 
引 脚 编号 |MPU-6000|MPU-6050| 引 脚 名 称 描 Æ 
1 Y Y CLKIN 可 选 的 外 部 时 钟 输入 ,如 果 不 用 则 连 到 GND 
6 Y Y AUX DA | 了 EC 主 串 行 数据 ,用 于 外 接 传感器 
7 Y Y AUX CL | FC 主 串 行 时 钟 , 用 于 外 接 传感器 
8 Y /CS SPI 3E (0— SPI mode) 
8 Y VLOGIC “| 数字 1/0 供电 电压 
2C Sla S "E- fr 中 
Pen PC Slave 地 址 LSBCADO); SPI 串 行 数据 输出 
(SDO) 
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续 表 
引 脚 编号 |MPU-6000| MPU-6050| 引 脚 名 称 d o 35 
9 Y ADO PC Slave 地 址 LSBCADO) 
10 Y Y REGOUT | 校准 滤波 电容 连 线 
11 Y Y FSYNC 帧 同步 数字 输入 
12 Y Y INT 中 断 数字 输出 ( 推 挽 或 开 漏 ? 
13 y VDD 电源 电压 及 数字 1/0 供电 电压 
18 Y Y GND 电源 地 
19,21,22 Y Y RESV 预备 ,不 接 
20 Y Y CPOUT 电荷 泵 电容 连 线 
23 Y SCL/SCLK | FC 串 行 时 钟 (SCL); SPI 串 行 时 钟 CSCLK) 
23 Y SCL EC 串 行 时 钟 (SCL) 
24 Y SDA/SDI |PC 串 行 数据 (SDA); SPI 串 行 数据 输 入 (SDD 
24 Y SDA FC 串 行 数据 (SDA) 
2,3,4,5,14, : _ 
15,16,17 i x is Tid 
(D 电压 : 3—6V. 
© 电流 : 二 10mA。 


@ 体积 : 15. 24mm X 15. 24mm X 2mm, 

CD 焊 盘 间距 : 上 下 100mil(2. 54mm) ,左右 600milC15. 24mm) 。 

C) 测量 维度 : 加 速度 .角速度 及 姿态 角 均 三 维 。 

© 量程 : 加 速度 为 土 16g ,角速度 为 士 2000"/s。 

C) 分 辨 率 : 加 速度 为 6. 1e，g, 角 速度 为 7. 6e 3 /s。 

稳定 性 : 加 速度 为 0.01g, 角 速度 为 0.05°/s。 

O 姿态 测量 稳定 度 : 0. 01°。 

O 数据 输出 频率 100Hz( 波 特 率 115 200)/20Hz( 波 特 率 9600) 。 

O 数据 接口 : 串口 (TTL 电 平 ) ,下 C( 直 接连 MPU6050 ,无 姿态 输出 ) 。 

此 类 数字 传感器 可 以 看 成 一 个 小 型 的 单片机 ,数据 存储 在 其 内 部 的 寄存 器 。 在 使 用 
时 ,首先 通过 下 C 总 线 对 其 控制 寄存 器 写 和 设置 位 数据 ,然后 通过 耻 C 总 线 从 存储 三 轴 旋 
转角 速度 的 寄存 器 中 读 回 数据 即 可 。 这 里 读 回 的 数据 可 以 是 MPU6050 的 ADC 传 回 的 
原始 数据 ,经 过 转化 为 四 元 数 和 欧 拉 角 后 可 以 用 来 修正 飞行 器 的 飞行 姿态 ,也 可 以 读 取 
MPU6050 内 部 集成 的 数字 运动 处 理 器 (DMP) 所 得 出 的 姿态 解 算 结果 ,从 而 单片机 只 需 
等 待 DMP 解 算 完 成 后 产生 的 外 部 中 断 , 使 得 单片机 能 有 大 量 的 时 间 来 处 理 其 他 任务 , 提 
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高 了 系统 的 实时 性 。 

在 具体 通信 中 ,需要 使 用 下 C 总 线 来 与 MPU6050 进行 数据 交互 。 得 到 了 MPU6050 
的 传 回 数据 之 后 ,就 能 够 对 数据 进行 融合 ,得 到 稳定 、 可 靠 的 姿态 数据 ,可 用 于 飞行 器 的 
平稳 飞行 控制 。 

3. 电子 调 速 器 

电子 调 速 器 在 航模 中 ,由 于 无 刷 电 机 在 同 功率 下 体积 要 比 有 刷 的 小 ,所 以 一 般 指 的 
是 “无 刷 电机 电子 调 速 器 ” ,通常 由 MOS 管 配合 单片机 组 成 ,其 主要 作用 是 把 航模 电池 提 
供 的 直流 电 转 换 成 三 相 驱 动 电流 ,并 通过 过 零 检测 等 电路 检测 无 刷 电 机 的 反馈 ,从 而 顺 
利 地 驱动 无 刷 电机 。 

现在 的 航模 电 调 品 牌 国外 以 美国 的 凤凰 最 为 出 名 ,国内 主要 品牌 有 好 盘 .中 特 威 、. 飞 
盈 佳 乐 等 。 选 择 合适 的 航模 电 调 需 要 根据 用 户 的 应 用 情况 和 电机 的 功率 要 求 来 选择 。 
选择 电 调 一 定 要 看 该 款 电 调 的 功率 ,另外 要 看 电 调 与 电机 的 兼容 度 。 电 调 并 不 能 兼容 所 
有 电机 , 它 必须 根据 电机 的 功率 等 参数 来 进行 选择 。 但 实际 情况 是 许多 品牌 的 电 调 并 不 
能 足 功率 足 电流 输出 ,如 60A 的 电 调 ,其 实 只 能 跑 到 55A 就 无 法 再 往 上 调 了 ,所 以 选择 
电 调 的 时 候 一 定 要 问 清楚 供应 商 是 否 足 功率 。 选 择 低 于 电机 功率 的 航模 电 调 会 导致 电 
调 板 上 功率 管 烧 坏 。 所 以 功率 问题 是 航模 电 调 选择 的 重要 问题 。 

无 刷 电机 电子 调 速 器 主要 特性 有 以 下 几 点 。 

CD 采用 功能 强大 ,高 性 能 MCU 处 理 器 ,用 户 可 以 针对 自身 需求 设置 使 用 功能 ,充分 
体现 系统 独 具 优 势 的 智能 特点 。 

@ 支持 无 刷 电机 无 限制 最 高 转速 。 

@ 支持 定 速 功能 。 

@ 精心 的 电路 设计 , 抗 干 扰 性 超 强 。 

© 启动 方式 可 设置 ,油门 响应 速度 快 ,并 具有 非常 平稳 的 调 速 线性 ,兼容 固定 翼 飞 机 
及 直 升 飞机 。 

© 低压 保护 阔 值 可 设置 。 

@ 内 置 SBEC, 带 能 机 负载 功率 大 、 功 耗 小 。 

@ 具备 多 种 保护 功能 。 输 入 电压 异常 保护 /电池 低压 保护 /过 热 保护 /油门 信号 丢失 
降 功 率 保护 。 

O 通电 安全 性 能 好 : 接 通 电源 时 无 论 遥 控 器 油门 拉杆 在 何 位 置 都 不 会 立即 启动 
电机 。 
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O 过 温 保 护 。 电 子 调 速 器 工作 中 当 温 度 到 达 100Y 时 功率 输出 会 自动 降低 一 半 E 


于 100C 时 功率 输出 自动 恢复 。 


(D 兼容 所 有 遥控 器 操作 设置 和 支持 编程 卡 设置 。 
O 设置 报警 音 ,判断 通电 后 工作 情况 。 


电子 调 速 器 有 许多 不 同 的 规格 , 表 4.1. 2 对 其 中 部 分 进行 了 列举 。 


表 4.1.2 电 调 产品 规格 


规格 持续 BEC BEC BEA RPM 尺寸 ( 宽 X | 质量 
电流 | 时 电流 | 输出 “| 模式 | F8 | AE | 长 x 高 mm | /8 
(10s) Li-xx Ni-xx 
SBEC/ ; 
FLY-10A 10A | 12A |5V/3A-1A 2-4Lipo | 5-12NC 60X26X9 | 26 
UBEC 
FLY-10A OPTO | 10A | 12A x 无 2-4Lipo | 5-12NC 60X26X9 | 23 
SBEC/ . 
FLY-20A 20A | 25A |5V/3A-1A 2-ALipo | 5-12NC | 54X26X11 | 30 
UBEC 
FLY-20A OPTO | 20A | 25A x X 2-ALipo | 5-12NC | 54X26X11 | 26 
SBEC/ : 
FLY-30A 30A | 40A |5V/3A-1A 2-ALipo | 5-12NC | 54X26X11 | 32 
UBEC 
FLY-30A OPTO | 30A | 40A x 无 2-4Lipo | 5-12NC | 54X26X11 | 28 
FLY-40A 40A | 60A |5.5V/4A | SBEC | 2-5Lipo | 5-15NC |35X71X10.5 | 48 
FLY-40A OPTO | 40A | 60A 无 无 2-5Lipo | 5-15NC | 35X71X10.5 | 42 
FLY-50A 50A | 80A |5.5V/4A | SBEC | 2-6Lipo | 5-18NC | 35X71X17 | 68 
FLY-50A OPTO | 50A | 80A 无 无 2-6Lipo | 5-18NC | 35X71X17 | 62 
FLY-60A 60A | 80A |5.5V/4A | SBEC | 2-6Lipo | 5-18NC | 35X71X17 | 68 
FLY-60A OPTO | 60A | 80A 无 无 2-6Lipo | 5-18NC | 35X71X17 | 62 
FLY-70A 70A | 100A |5.5V/4A | SBEC | 2-6Lipo | 5-18NC | 35X71X17 | 69 
FLY-70A OPTO | 70A | 100A 无 无 2-6Lipo | 5-18NC | 35X71X17 | 63 
FLY-80A 80A | 100A |5.5V/4A | SBEC | 2-6Lipo | 5-18NC | 35X66X22 | 90 
FLY-80A OPTO | 80A | 100A 无 无 2-6Lipo | 5-18NC | 35X66X22 | 82 
FLY-90A 90A | 120A |5.5V/4A | SBEC | 2-6Lipo | 5-18NC | 35X66X22 | 95 
FLY-90A OPTO | 90A | 120A x X 2-6Lipo | 5-18NC | 35X66X22 | 87 
FLY-100A 100A| 140A |5.5V/4A | SBEC | 2-6Lipo | 5-18NC | 35X71X22 | 95 
FLY-100A OPTO |100A | 140A 无 无 2-6Lipo | 5-18NC | 35X71X22 | 87 
FLY-110A 110A| 150A |5.5V/4A | SBEC | 2-6Lipo | 5-18NC | 35X71X22 | 95 
FLY-110A OPTO | 110A | 150A 无 无 2-6Lipo | 5-18NC | 35X71X22 | 87 
FLY-120A 120A| 150A |5.5V/4A | SBEC | 2-6Lipo | 5-18NC | 35X71X22 | 98 
FLY-120A OPTO |120A | 150A 无 无 2-6Lipo | 5-18NC | 35X71X22 | 90 
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电子 调 速 器 的 接线 如 图 4. 1.9 所 示 。 
ER] 


电池 组 | 
A 


里 一 
sm — ME 
图 4.1.9. 电子 调 速 器 连接 线 说 明 (为 避免 短路 和 漏电 ,连接 处 均 使 用 热 缩 导 管 绝缘 ) 

不 同 的 电 调 有 不 同 的 设置 指令 (通常 是 从 信号 引 脚 输入 不 同 占 空 比 的 PWM 波 )， 
飞行 控制 接收 机 或 者 其 他 能 发 出 50Hz,5% ~10% Ky PWM 波 设备 (信号 源 、. 遥 控 器 、 
发 射 机 等 ) 均 可 以 对 电 调 进行 各 种 设置 。 需 要 特别 说 明 的 是 ,一 般 而 言 , 电 调 的 BEC 输 
出 是 5V, 但 电 调 的 控制 信号 并 不 需要 5V, 只 是 3. 3V 就 可 以 识别 了 。 这 是 因为 5V 类 
型 电 平 (CMOS 电 平 ) 的 高 电 平 识别 下 限 是 2.7V, 而 目前 常用 的 3. 3V 单片机 输出 的 高 
电 平 已 经 超过 了 这 个 下 限 ,因此 在 使 用 此 类 单片机 调试 电 调 的 时 候 不 用 刻意 去 设计 电 
平 转换 电路 。 

从 说 明 书 可 以 获得 电子 调 速 器 的 设置 方法 ,其 中 最 重要 的 是 油门 行程 的 设置 。 油 门 
行程 是 指 当 信号 接收 引 脚 收 到 的 PWM 波 的 占 空 比 变化 1% 时 , 电 调控 制 电 机 转速 对 应 
进行 多 少 变化 。4 个 电 调 必须 有 同样 的 油门 行程 ,这 样 当 飞行 控制 控制 电 调 从 而 控制 电 
机 转速 时 ,对 应 的 转速 变化 才 比 较 好 控制 。 

油门 行程 的 设置 方法 (当前 大 多 兼容 电 调 程序 ) 如 图 4. 1. 10 所 示 。 


Jo Rin 


JRBBIEN. t 将 电 调 接 上 电 PEREAT HEORNR | oi i suma e ER [xau 
油门 达到 最 高 点 [ 7] 池 ， 等 到 3s | 7| 最 高 点 的 声音 KFIS Mar 低 点 确认 音 可 以 起 
m3 * HOK, ilk 
- 电 Jii ens B OK i e 
开启 通 控 器 ， 将 ae] 地， 鸣叫 提示 =| i. HG | 08 irte, ec E: DES 
油门 达到 最 高 点 音符 "123”， 表 池 节 数 准备 就 绪 
示 上 电 正常 ih 


图 4.1.10 电 调 油门 行程 校准 过 程 
这 一 过 程 从 信号 变化 来 看 ,就 是 保持 10% 左 右 的 占 空 比 一 等 待 2s 一 等 待 确认 音 一 保 
持 5% 左 右 占 空 比 一 等 待 1s 一 确认 锂电 池 和 油门 。 也 就 是 一 个 让 电 调 确定 收 到 的 PWM 
波 占 空 比 的 范围 ,从 而 能 够 根据 这 个 范围 来 确认 , 当 占 空 比 变化 时 ,自己 应 该 怎么 控制 电 
机 转速 做 出 相应 变化 的 过 程 。 
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4. 无 线 通信 模块 

2. 4GHz ISM(Industry Science Medicine) 是 全 世界 公开 通用 的 无 线 频段 ,被 目前 广 
泛 应 用 于 家 用 及 商用 领域 , 它 是 一 个 全 球 性 的 频段 ,开发 的 产品 具有 全 球 通用 性 ,各 类 无 
线 产 品 均 可 使 用 此 频段 来 实现 无 线 通 信 的 功能 。 下 面 介绍 一 种 基于 该 频段 的 无 线 通 信 
模块 一 一 nRF2401。 

nRF2401 支持 多 点 间 通 信 , 最 高 传输 速率 超过 1Mb/s, 而 且 比 蓝牙 具有 更 高 的 传输 速 
度 。 它 采用 SoC 方法 设计 ,只 需 少量 外 围 元 件 便 可 组 成 射频 收发 电路 。 与 蓝牙 不 同 的 是， 
nRF2401 没有 复杂 的 通信 协议 , 它 完全 对 用 户 透 明 , 同 种 产品 之 间 可 以 自由 通信 。 更 重要 
的 是 ,nRF2401 比 蓝牙 产品 更 便宜 。 所 以 nRF2401 是 业界 体积 最 小 、 功 耗 最 少 、 外 围 元 件 最 
少 的 低 成 本 射频 系统 级 芯片 。nRF2401 内 置地 址 解码 器 、 先 入 先 出 堆栈 区 、 解 调处 理 器 、 时 
钟 处 理 器 .GFSK 滤波 器 、 低 噪声 放大 器 ,频率 合成 器 及 功率 放大 器 等 功能 模块 ,只 需要 很 少 
的 外 围 元 件 , 使 用 起 来 非常 方便 。QFN24 引 脚 封装 ,外 形 尺 寸 只 有 5mmX5mm。 

nRF2401 的 功能 模块 如 图 4. 1. 11 所 示 , 引 脚 排列 如 图 4. 1. 12 所 示 , 引 脚 功 能 如 
K 4.1.3 所 示 。 


A > > > > >>> 
niii ai 
ai 3| SII >| = 人 人 
ki 
PWR UP -a i à 
— DuoCeiverTM = 
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le VSS PA-0V 
a DEMOD È ) SNR 上 ~ VDD PS-1.8V 
M NS = 
ecovery, 
DR2 | DataSlicer 
Data DOUT2 ADDR 
Chared2 CLE: 2 Decode 
e| CRC Frequency 
Bei Code/Decode Synthesiser 
EL m 
Data DATA ut | ANTI 
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| GFSK PA 4000 
3-wire Filter ANT2 
interface : 
cs | IREF 
S s m 
22kQ 


图 4.1.11 nRF2401 功能 模块 
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CE |! 


DR2 |2 


CLK2 | 3 


DOUT2 |4 


CS [5 


DRI | 6 


VDDPWR UP VSS VDD VSS IREF 


24] [23] [22] [21] [20] [19 
e 18 ] vss 
nRF2401 
QFN24 5X 5 UNDO 
16] VSS PA 
A 
Y 15] ANT2 
14 | ANTI 
13] vbD PA 
7]Ls8 9 ] [10] Lu [12] 
CLKI DATA DVDD VSS XC2 XCI 


Æ 4.1.12 nRF2401 引 脚 排列 


nRF2401 的 主要 特点 如 下 。 
CD 采用 全 球 开 放 的 2. 4GHz 频段 ,有 125 个 频道 ,可 满足 多 频 及 跳 频 需要 。 

© 速率 (1Mb/s) 高 于 蓝牙 , 且 具 有 高 数据 吞吐 量 。 

© 外 围 元 件 极 少 ,只 需 一 个 晶振 和 一 个 电阻 即 可 设计 射频 电路 。 

@ 发 射 功 率 和 工作 频率 等 所 有 工作 参数 可 全 部 通过 软件 设置 。 

C) 每 个 芯片 均 可 以 通过 软件 设置 最 多 40 位 地 址 ,而 且 只 有 收 到 本 机 地 址 时 才 会 输 


出 数据 (提供 一 个 中 断 指示 ) ,同时 编程 也 很 方便 。 


© 采用 ShockBurstl M 模式 时 ,能 适用 极 低 的 功率 操作 和 不 严格 的 MCU 执行 。 
CD 带 有 和 集成 增强 型 8051 内 核 .9 路 10 位 ADC, UART 异步 串口 .SPI 串口 和 PWM 输出 。 


内 置 看 门 狗 。 
表 4.1.3 nRF2401 各 引 脚 功能 说 明 
引 脚 名 称 引 脚 功能 d 述 
1 CE 数字 输入 使 nRF2401 工作 于 接收 或 发 送 状态 
2 DR2 数字 输出 频道 2 接收 数据 准备 好 
3 CLK2 数字 1/O 频道 2 接收 数据 时 钟 输入 输出 
4 DOUT2 数字 输出 频道 2 接收 数据 
5 CS 数字 输入 配置 模式 的 片 选 端 
6 DR1 数字 输出 频道 1 接收 数据 准备 好 
7 CLK1 数字 LO 频道 1 接收 数据 时 钟 输入 输出 
8 DATA 数字 1/0 频道 1 接收 发 送 数据 端 
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续 表 

引 脚 名 称 引 脚 功能 d 述 

9 DVDD 电源 电源 的 正 数字 输出 

10 VSS 电源 电源 地 

11 Xci 模拟 输出 晶振 1 

12 XC2 模拟 输入 晶振 2 

13 VDD_PA 电源 输出 给 功率 放大 器 提供 1. 8V 的 电压 
14 ANTI XH 天 线 接 口 1 

15 ANT2 天 线 天 线 接口 2 

16 VSS PA 电源 电源 地 

17 VDD_PA 电源 电源 正 端 

18 VSS 电源 电源 地 

19 IREF 模拟 输入 模 数 转换 的 外 部 参考 电压 

20 VSS 电源 电源 地 

21 VDD_PA 电源 电源 正 端 

22 VSS 电源 电源 地 

23 PWR_UP 数字 输入 芯片 激活 端 

24 VDD 电源 电源 正 端 


nRF2401 有 4 种 工作 模式 (如 表 4. 1.4 所 示 ), 即 收发 模式 .配置 模式 、 空 闲 模式 和 关 
机 模式 ,由 PWR_UP、CE、 和 CS 这 3 个 引 脚 决定 。 


表 4.1.4 nRF2401 工作 模式 


工作 模式 PWR_UP CE CS 
收发 模式 1 0 
配置 模式 1 0 1 
空闲 模式 1 0 0 
关机 模式 0 X X 


收发 模式 : nRF2401 的 收发 模式 有 ShockBurstTM 收发 模式 和 直接 收发 模式 两 种 ， 
收发 模式 由 器 件 配置 字 决定 。 这 里 只 介绍 ShockBurstTM 收发 模式 。 

ShockBurstTM 收发 模式 下 ,使 用 片 内 的 先入 先 出 堆栈 区 ,数据 低速 从 微 控 制 器 送 入 
而 高 速 (1Mb/s) 发 射 ,这 样 可 以 尽量 节能 ,因此 ,使 用 低速 的 微 控制 器 也 能 得 到 很 高 的 射 
频数 据 发 射 速率 。 与 射频 协议 相关 的 所 有 高 速 信号 处 理 都 在 片 内 进行 ,这 种 做 法 有 三 大 
好 处 : 尽量 节能 ; 低 的 系统 费用 (低速 微 处 理 器 也 能 进行 高 速射 频 发 射 ); 数据 在 空中 停 
留 时 间 短 , 抗 干 扰 能 力 强 。nRF2401 的 ShockBurstTM 技术 同时 也 减 小 了 整个 系统 的 平 


均 工作 电流 。 
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在 ShockBurstTM 收发 模式 下 ,nRF2401 自动 处 理 字 头 和 CRC 校 验 码 。 在 接收 数 
据 时 ,自动 把 字 头 和 CRC 校 验 码 移 去 。 在 发 送 数据 时 ,自动 加 上 字 头 和 CRC 校 验 码 , 当 
发 送 过 程 完成 后 ,数据 准备 好 引 脚 通 知 微 处 理 器 数据 发 射 完毕 。 

配置 模式 : 在 配置 模式 ,15B 的 配置 字 被 送 到 nRF2401, 这 需 通过 CS,CLK1 和 
DATA 3 个 引 脚 完 

空闲 模式 : nRF2401 的 空闲 模式 是 为 了 减 小 平均 工作 电流 而 设计 ,其 最 大 优点 是 ， 
实现 节能 的 同时 缩短 芯片 的 启动 时 间 。 在 空闲 模式 下 ,部 分 片 内 晶振 仍 在 工作 ,此 时 的 
工作 电流 跟 外 部 晶振 的 频率 有 关 , 如 外 部 晶振 为 4MHz 时 工作 电流 为 12wA, 外 部 晶振 为 
16MHz 时 工作 电流 为 32wA。 在 空闲 模式 下 ,配置 字 的 内 容 保持 在 nRF2401 片 内 。 

关机 模式 : 在 关机 模式 下 ,为 了 得 到 最 小 的 工作 电流 ,一 般 此 时 的 工作 电流 小 于 
lxA。 关 机 模式 下 ,配置 字 的 内 容 也 会 被 保持 在 nRF2401 片 内 ,这 是 该 模式 与 断 电 状态 
最 大 的 区 别 。 

5. 电源 模块 

电源 电路 作为 整个 系统 的 动力 源泉 必须 要 设计 合理 ; 否则 会 造成 系统 工作 不 稳定 。 
对 于 地 面 站 系统 ,STM32F103RBT6 使 用 3. 3V 电源 作为 系统 电源 ,而 通常 的 外 部 电源 为 
5V, 所 以 必须 要 通过 电源 转换 电路 进行 降 压 稳 压 处 理 , 如 使 用 AMS1117 线性 稳 压 芯片 ， 
参考 AMS1117 的 数据 手册 并 且 辅 以 适当 的 外 于 电路 便 可 设计 出 满足 要 求 的 5V 转 3.3V 
的 电源 电路 ,如 图 4. 1.13 所 示 。 

对 于 飞行 器 的 供电 , 则 需要 高 性 能 的 航模 电池 。 航 模 电 池 常 常用 几 个 S 来 代表 有 几 
片 电池 串联 ,1S 表示 一 片 电池 3. 8V ,充满 电 4.2V。 除 了 S 数值 是 选择 电池 的 常用 标准 
外 ,还 有 以 下 指标 需要 注意 。 

(D 电池 的 C 数 。 一 般 航 模 电 池 会 标明 电池 的 C 数 , 指 的 是 最 大 放电 倍率 。 例 如 ,使 
用 的 1S 锂电 池 , 一 般 是 350mAh、25C。 那 么 这 个 电池 最 大 可 以 提供 的 电流 就 是 
0.35AX25 一 8.75A。 

O 电池 的 容量 。 容 量 越 大 ,存储 的 能 量 就 越 大 ,可 以 提供 的 续航 时 间 就 越 长 ,不 过 相 
应 的 重量 也 越 大 。 较 大 的 四 旋 愤 飞行 器 常用 2200mAh,3S,25C 的 电池 。 

注意 使 用 对 应 的 充电 器 。 由 于 航模 电池 的 电流 极 大 ,因此 一 般 采 用 平衡 充电 器 来 分 
别 充 其 中 的 每 一 个 S, 也 就 是 每 一 个 放电 单元 ,这 样 比较 保护 电池 。 不 过 由 于 小 四 旋 愤 飞 
行 器 的 电池 只 有 一 个 S, 所 以 可 以 用 比较 简单 的 充电 器 完成 充电 。 不 要 过 度 放电 。 航 模 
电池 如 果 放电 过 多 ,会 导致 下 一 次 无 法 使 用 ,电池 也 会 起 鼓 包 。 


第 4 章 ”四 旋翼 飞行 器 硬件 系统 设计 | 71 


EM 33V 
i 2 {i 2 
3 4 H 4 1 
PWI 二 PW2 = 
GND GND 
5v 33v 
AMSI117-33 


» + IN OUT 
GND 
d+c G G db Ris 


o— 
SW SPDT Ss 


GND 
图 4.1.13 线性 稳 压 电源 电路 
四 旋 必 飞行 器 电池 还 要 注意 分 线 板 的 使 用 。 由 于 电池 只 有 一 个 工 形 搬 口 ,但 是 要 将 
电量 分 给 4 个 电 调 使 用 ,分 线 板 可 以 将 多 个 电 调 并 联 到 电池 电源 上 。 
最 后 ,电池 在 使 用 的 过 程 中 ,需要 注意 与 机 身 的 固定 ,以 免 飞行 中 掉 落 。 大 四 旋 愤 飞 
行 器 有 专门 的 绑 带 出 售 ,小 四 旋翼 飞行 器 电池 可 以 用 透明 胶带 或 者 双 面 胶 粘 贴 。 


4.1.2 外 围 传感器 


1. GPS 定位 模块 

全 球 定位 系统 (Global Positioning System,GPS) 起 始 
于 1958 年 美国 军 方 的 一 个 项 目 ,1964 年 投入 使 用 ,其 基本 
原理 是 测量 出 已 知 位 置 的 卫星 到 用 户 接收 机 之 间 的 距离 ， 
然后 综合 多 颗 卫 星 的 数据 就 可 知道 接收 机 的 具体 位 置 。 四 
旋 沟 飞行 器 在 室外 飞行 时 ,通过 搭载 的 GPS 可 以 获取 飞行 
器 当前 所 处 的 位 置 和 速度 信息 。 

图 4. 1. 14 所 示 为 瑞士 U-blox 公司 推出 的 NEO6 系列 
GPS 模块 ,图 4.1. 15 所 示 为 其 设计 原理 图 。 这 块 GPS 模块 是 2009 年 推出 的 ,降低 了 


图 4.1.14 NEO-6 GPS 模块 
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GPS 模块 的 功 耗 , 具 备 智能 化 功率 管理 功能 ,延长 了 电池 寿命 。 同 时 NEOG 模块 中 捕获 
引擎 的 相关 数量 拓展 到 200 万 个 以 上 ,在 提高 微弱 信号 捕获 能 力 的 同时 ,缩短 了 首次 定 
位 时 间 。NEO6 具有 以 下 特点 。 

(D UART 接口 : 支持 数据 传输 速率 4. 8 一 230KB/s, 信 号 输入 输出 电 平 为 Veco 

@ USB2. 0 接口 : 支持 全 双 工 模式 ,数据 传输 速率 可 达 12Mb/s。 

G DDC(Display Data Channel); 兼容 PC 接口 , NEO6 接收 机 运行 在 fC 从 模式 
下 。 当 外 部 有 EEPROM 时 ,可 以 工作 在 主 模式 下 。 

@ SPI 接口 : 允许 NEO6 通过 SPI 接口 连接 外 部 的 设备 ,如 Flash, AD 转换 器 ,或 者 
是 主 CPU。 

© 丰富 的 GPIO 接口 。 

此 外 ,NEO6 GPS 模块 还 具有 以 下 特性 。 

(D 模块 采用 U-BLOX NEO-6M 模 组 ,体积 小 巧 ,性 能 优异 。 

@ 模块 增加 放大 电路 ,有 利于 无 缘 陶 瓷 天 线 快速 搜索 卫星 。 

@ 模块 可 通过 串口 进行 各 种 参数 设置 ,并 可 保存 在 EEPROM 中 ,使 用 方便 。 

@ 模块 自 带 SMA 接口 ,可 以 连接 各 种 有 源 天 线 , 适 应 能 力 强 。 

C) 模块 兼容 3. 3V/5V 电 平 ,方便 连接 各 种 单片机 系统 。 

@ 模块 白带 可 充电 后 备 电池 ,可 以 掉 电 保持 星 历数 据 。 

2. 磁力 计 (HMC5883) 


霍 尼 韦 尔 HMC5883L 磁 强 计 是 一 种 采用 无 铝 表面 封装 技术 的 高 集成 模块 , 带 有 数 
字 接 口 的 弱 磁 传感器 芯片 ,其 包括 高 分 辩 率 的 HMC118X 系列 磁 阻 传感器 、 放 大 器 、 自 动 
消 磁 驱 动 器 、 偏 差 校准 和 数 模 转换 器 。 

其 引 脚 配置 如 图 4.1.16 所 示 。 

HMC5883L 磁 强 计 相 关 参 数 如 下 : 

(D 封装 尺寸 : 3. 0mmX3.0mmX0. 9mm。 

@ 测量 分 辩 率 : 5mGa。 

© 工作 电压 : 2. 16—3.6V. 

@ 测量 精度 : 1" 一 2"。 

© 工作 电流 : 1004A. 

© 最 大 输出 频率 : 160Hz。 

© 工作 温度 : —40—--85'C, 
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E 4.1.16 HMC5883L 磁 强 计 引 脚 排列 


@ 寄存 器 位 数 : 8 位 。 

© 测量 磁场 范围 : 士 8Ga。 

D ADC fX: 12 位 。 

HMC5883L 磁 强 计 采 用 各 向 异性 磁 阻 (MR) 技 术 使 各 向 异性 传感器 具有 在 轴 向 高 
灵敏 度 和 线性 高 精度 的 特点 ,通过 施加 供电 电源 ,传感器 可 以 将 测量 轴 方 向 上 的 任何 入 
射 磁场 转变 成 一 种 差分 电压 输出 ,这 些 磁 阻 元 件 两 两 对 齐 ,形成 一 个 共同 的 敏感 轴 ( 如 引 
脚 图 上 的 箭头 所 示 ) , 随 着 磁场 在 敏感 轴 向 上 不 断 增强 ,电压 也 x 
就 正 向 增强 ,该 磁 强 计 能 够 可 靠 测 量 地 球 磁场 的 方向 和 大 小 。 Hy 
HMC5883L 通过 总 线 来 控制 ,外 接 电 阻 后 ,可 支持 标准 模式 。 
100kHz 和 快速 模式 400kHz 的 时 钟 频率 ,但 不 支持 高 速 模式 。 

其 内 部 时 钟 具有 数字 逻辑 功能 和 定时 管理 功能 。HMC5883L . 
[S T DIE PNEIIT E31 17 S72 PS MNA d 


Lor idc 


然后 确定 磁 北 极 和 与 前 进 方向 的 夹 角 。 当 磁 强 计 水 平 放 置 时 ， Z 
其 传感器 的 坐标 轴 如 图 4. 1. 17 所 示 。 图 4.1.17 人 磁 强 计 传感器 
XY 轴 在 水 平面 内 ,X 轴 指 向 前 进 方向 ,Z 轴 沿 重力 方向 坐标 系 


向 下 ,Y 轴 根 据 右手 坐标 系 确定 。 从 磁 北 极 与 轴 正 方向 沿 顺 时 

针 方向 的 夹 角 即 为 方位 角 a。 磁 北极 为 地 球 磁场 沿 水 平方 向 的 分 量 , 而 地 磁场 的 北极 和 
地 理 北 极 有 差别 , 且 处 在 地 球 上 的 位 置 不 同 ,这 种 差别 也 相应 不 同 。 所 以 HMC5883L 在 
使 用 时 需要 初始 化 , 先 补偿 当地 的 磁场 大 小 和 方向 , 即 当地 的 磁 偏 角 , 然 后 才能 计算 出 
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磁 北 极 和 地 北极 的 差 值 ,从 而 得 出 正确 的 地 理 北极 方向 。 

实际 情况 下 , 当 四 旋翼 飞行 器 飞行 时 , 磁 强 计 并 不 水 平 ,此 时 需要 根据 坐标 变化 计算 
其 水 平方 向 分 量 。 

3. 气压 计 (BMP085) 

BMP085 是 一 款 高 精度 、 超 低能 耗 的 压力 传感器 ,可 以 应 用 在 移动 设备 中 。 它 的 性 
能 卓越 ,绝对 精度 最 低 可 以 达到 0. 03hPa, 并 且 耗 电极 低 , 只 有 34A, BMP085 采用 强大 
的 8 脚 陶瓷 无 引线 芯片 承载 (LCC) 超 薄 封装 ,可 以 通过 了 fC 总 线 直接 与 各 种 微 处 理 器 相 
连 。 图 4. 1. 18 是 其 封装 外 形 和 引 脚 排列 。 主 要 特点 如 下 。 

(D 压力 范围 : 300 一 1100hPa( 海 拔 9000—500m) . 

© 电源 电压 : 1. 8 一 3. 6V(VppA) ,1. 62 一 3. 6V(CVpop) 。 

@ LCC8 封装 : 无 铅 陶 资 载体 封装 (LCC) 。 

@ 尺寸 : 5.0mmX 5. 0mm X 1. 2mm, 

C) 低 功 耗 : 5p A 在 标准 模式 。 

© 高 精度 : 低 功 耗 模式 下 ,分 辩 率 为 0. 06hPa (0. 5m) ,高 线性 模式 下 ,分 辩 率 为 
0. 03hPa(0. 25m) 。 

@ 反应 时 间 : 7.5ms。 

@ 待机 电流 : 0. 1mA。 

© 无 须 外 部 时 钟 电路 。 

O 含 温 度 输出 ,IC 接口 ,温度 补偿 ,无 铅 ,符合 RoHS 规范 , MSL 1。 


E |7 
2 E ENG 
[| E]; 


图 4.1.18 封装 外 形 和 引 脚 排列 


引 脚 各 功能 如 下 : 1 脚 (GND) 接 电源 地 ,2 脚 (EOC) 为 完成 转换 输出 ,3 脚 (VDDA) 
为 正 电 源 ,4 脚 (VDDD) 为 数字 正 电源 ,5 脚 为 空 ,6 CSCL H PC 总 线 的 时 钟 端 ,7 脚 
(SDAD H PC 总 线 的 数据 端 ,8 脚 (XCLR) 为 主 清除 信号 输入 端 , 低 电 平 有 效 , 用 来 复位 
BMP085 和 初始 化 寄存 器 和 控制 器 ,在 不 用 的 情况 下 可 以 空置 。 
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4. 超声 波 模 块 

由 于 超声 波 传感器 的 成 本 低 .实现 方法 简单 .技术 成 熟 ,是 无 人 机 常用 的 传感器 。 由 
于 对 不 同 材 料 声 波 的 反射 是 不 同 的 , 且 易 受到 其 他 声波 干扰 ,以 及 超声 波 的 测量 周期 较 
长 ,所 以 超声 波 传感器 一 般 只 用 在 探测 几米 之 内 的 距离 。 

四 旋 没 无 人 直升机 在 飞行 高 度 要 求 不 高 ,对 精度 的 要 求 也 不 是 很 高 的 情况 下 ,可 
选用 的 超声 波 为 US-100 或 者 KS-103H。 模 块 共 有 两 个 接口 , 即 模式 选择 跳 线 和 5 针 
接口 。 

模式 选择 跳 线 的 间距 为 2. 54mm, 当 插 上 跳 线 帽 时 为 UART( 串 口 ) 模 式 , 拔 掉 时 为 
电 平 触发 模式 。UART( 串 口 ) 模 式 实时 性 不 高 ,采集 的 数据 不 适合 用 作 无 人 机 的 定 高 ， 
因此 推荐 使 用 电 平 触发 模式 。 

5. 光 流 视觉 定位 传感器 

ADNS-3080 光 流 传感器 价格 低廉 ,容易 读 取 数 据 , 但 对 地 面 要 求 很 高 。ADNS-3080 
是 一 款 光 电 鼠 标 传感器 ,SPI 数据 接口 ,原理 图 如 图 4. 1. 19 所 示 。 读 出 的 数据 需要 进行 
高 度 修 正 , 即 读 出 来 的 像素 移动 值 输出 结果 需要 根据 高 度 来 标定 ,为 了 找到 正确 的 缩放 
因子 ,传感器 将 某 个 高 度 作为 参考 ,在 不 同 的 高 度 多 次 水 平移 动 相同 距离 , 求 出 缩放 因 
T ,使 得 不 同 高 度 移动 相同 距离 变化 的 像素 值 相同 。 具 体 的 软件 编程 见 后 面部 分 。 


CMOS 帧 捕获 
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微 控制 器 


图 4.1.19 光 流 原理 图 
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另 一 款 为 对 地 面 要 求 相对 来 说 更 加 接近 真实 环境 的 光 流 传感器 一 一 PX4Flow, 串 口 
传输 数据 。 但 需要 对 MAVLink 协议 进行 解析 ,相对 复杂 一 些 , 但 已 经 进行 过 高 度 修正 ， 
具体 的 软件 编程 见 第 5 章 。 

接 下 来 介绍 它们 的 结构 和 工作 原理 。 

光 流 图 像 数据 来 自 于 CMOS 机 器 视觉 传感器 。 和 ARM Cortex MA 处 理 器 的 专用 
图 像 接 口 相连 ,以 便 微 处 理 器 能 实时 处 理 图 像 。 帧 捕获 模块 将 抓 取 到 的 图 像 数 据 存在 处 
理 器 存储 器 中 , 光 流 模块 通过 连续 的 两 帧 图 像 计算 光 流 数据 ,通过 细 化 获取 的 子 像素 和 
陀螺 仪 角速度 对 计算 结果 做 进一步 处 理 ,最 后 将 计算 结果 转化 为 以 m 为 单位 的 信息 。 

图 像 数 据 通过 并 口 送 到 微 处 理 器 ,处 理 器 帧 捕获 模块 在 像素 时 钟 的 控制 下 采取 像素 
数据 ,并 通过 DMA 送 到 存储 器 。DMA 设 定 了 两 个 缓冲 区 ,交替 接收 图 像 数 据 。 存 储 器 
中 只 需 存 储 当 前 和 上 次 采集 到 的 图 像 即 可 。 

光 流 由 连续 的 两 帧 图 像 数据 进行 计算 。 采 用 SAD(Sum of Absolute Differences , 绝 
对 误差 和 ) 匹 配 算法 。SAD 算法 的 基本 流程 如 下 。 

CD 构造 一 个 小 窗口 ,类似 于 卷 积 核 。 

© 用 窗口 覆盖 左边 的 图 像 ,选择 窗口 覆盖 区 域内 的 所 有 像素 点 。 

© 同样 用 窗口 覆盖 右边 的 图 像 , 并 选择 覆盖 区 域 的 像素 点 。 

@ 左边 覆盖 区 域 减 去 右边 覆盖 区 域 , 并 求 出 所 有 像素 点 差 的 绝对 值 的 和 。 

© 移动 右边 图 像 的 窗口 ,重复 @ 和 @ 的 动作 (这 里 有 个 搜索 范围 ,超过 这 个 范围 则 跳出 )。 

© 找到 这 个 范围 内 SAD 值 最 小 的 窗口 , 即 找到 了 左边 图 像 的 最 佳 匹配 的 像素 块 。 

通过 对 比 当 前 图 像 和 前 一 帧 图 像 特定 区 域 的 SAD 值 , 找 出 最 接近 的 作为 光 流 运算 
结果 。 为 了 支持 不 同 的 应 用 ,对 搜寻 范围 和 模板 大 小 可 以 进行 配置 。 计 算出 匹配 数据 
后 ,通过 双 线 性 插值 (计算 相 邻 两 个 像素 点 的 平均 值 作为 子 像素 ) 获 取 的 子 像素 做 进一步 
查询 匹配 ,使 精度 达到 亚 像素 级 。 陀 螺 仪 角速度 数据 可 以 用 来 补偿 纠正 由 于 旋转 引起 的 
光 流 移动 ,使 计算 结果 真实 反映 水 平 的 移动 。 随 着 旋转 方向 的 不 同 ,SAD 查找 窗口 可 以 
移动 ,这 样 使 光 流 在 水 平方 向 查找 范围 很 小 的 情况 下 允许 的 旋转 速度 更 大 。 

SAD 算法 将 图 像 分 成 大 小 为 8X8 的 特征 模板 。 每 次 会 搜寻 正 负 4 个 像素 的 数据 进 
行 匹配 运算 。 每 个 采样 点 会 和 81 个 四 周 的 像素 点 进行 SAD 运算 ,并 将 值 最 小 的 作为 匹 
配点 。 每 帧 处 理 64 个 采样 点 ,对 每 个 采样 点 采用 直方 图 滤波 , 选 出 槽 最 大 的 值 , 值 以 像 
素 为 单位 。 在 lm 高 的 距离 , 帧 率 为 250、 焦 距 为 16mm 搜寻 范围 为 正 负 4 个 像素 点 的 条 
件 下 ,可 测 的 最 大 地 面 速度 为 土 1. 5m。 在 基于 像素 点 计算 出 最 好 的 光 流 数据 后 ,通过 子 
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像素 做 进一步 细 分 。 子 像素 通过 双 线 性 插值 获得 ,通过 子 像素 在 各 个 方向 上 的 进一步 匹 
配 ,结合 基于 像素 计算 的 数据 ,一 起 作为 最 终 的 匹配 结果 。 

光 流 所 用 镜头 接口 为 M12, 焦 距 16mm,FOV( 视 场 角 ) 为 21 ,有 红外 过 滤 功 能 。 摄 
像 头 采用 的 是 镁 光 MT9V034, 像 素 点 大 小 为 um, 最 大 分 辩 率 为 752HXx480V。 最 大 分 
辩 率 下 的 最 高 帧 率 为 60fps。 有 binning 功能 (是 一 种 图 像 读 出 模式 ,将 相 邻 像 元 感应 的 
电荷 加 在 一 起 ,以 一 个 像素 的 模式 读 出 ) ,在 4 倍 binning 下 ,分 辩 率 为 188HX120V, 最 
高 帧 率 可 到 250fps。binning 功能 由 摄像 头 自己 完成 ,4 倍 binning 时 ,输出 的 图 像 每 个 像 
素 点 对 应 的 为 4X4 个 原始 像素 的 均值 。 图 像 处 理 器 采用 32 位 的 STM32F407, 人 处理 器 
采用 Cortex M4F 核 , 168MHz 主 频 , 192KB RAM, 有 浮 点 运算 单元 。 陀 螺 仪 选用 
L3GD20.16 位 的 分 辩 率 ,最 大 测速 到 2000"/s。 此 外 ,还 有 EEPROM 用 以 存储 光 流 参 
数 。 声 纳 传感器 选用 Maxbotics 公司 的 HRLV-EZ4, 该 传感器 小 巧 、 轻 便 。 

ARM Cortex MAF 微 处 理 器 提供 了 一 个 可 配置 尺寸 和 像素 深度 的 图 像 获 取 接 口 。 
采用 8 位 每 个 像素 的 分 辩 率 ,以 便于 使 用 ARM. 一 次 可 以 处 理 32 位 的 指令 每 次 处 理 4 个 
像素 点 。 图 像 接口 通过 DMA 将 图 像 数据 存放 在 处 理 器 内 部 的 存储 空间 中 。Cortex M4 
专门 的 整数 向 量 指令 在 一 个 CPU 时 钟 里 一 次 可 以 并 行 处 理 4 个 像素 的 数据 。 

PX4Flow 是 一 款 智 能 光学 流动 传感器 (如 图 4. 1. 20 
所 示 ) ,计算 光学 流 的 过 程 中 采用 了 4 倍 分 级 和 剪裁 算 
法 (4X4 分 级 图 像 算 法 ) , 光 流 运算 速度 从 120Hz( 室 内 ) 
至 250Hz( 室 外 ); 高 感光 度 , 有 24umX24 pm 高 像素 。 
一 个 光 流传 感 器 所 包含 的 部 件 如 下 。 

(D STM32F405, 168MHz Cortex M4F ( 单 精 度 浮 


2 --.G4KB RAND, 图 4.1.20. PXAFlow 光 流 传感器 
Q) 752X480 MT9V034 机 器 视觉 图 像 CMOS 传 感 
器 ,L3GD20 三 轴 陀 螺 。 
© 16mm M12 镜头 (集成 红外 滤 光 片 ) 。 
@ 外 形 尺寸 : 45.5 mmX35mm。 
© 功 耗 : 115mA/5V。 
PX4Flow 模块 使 用 USB 和 UART 输出 MAVLink 协议 包 , 波 特 率 为 115 200。 可 
以 使 用 地 面 站 QGroundControl 从 光 流 中 读 取 数据 。PX4Flow 光 流 传感器 能 通过 检测 
视觉 芯片 感知 区 域 的 变化 ,测量 图 像 的 移动 速度 。 通 过 测量 暗 点 和 光 点 经 过 芯片 的 速 
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JE ,就 能 够 检测 出 图 像 移动 的 速度 。 它 有 强大 的 图 像 捕 提 能 力 , 也 就 意味 着 它 能 够 处 理 
更 多 样 的 地 面 情况 ,这 使 四 旋 辟 飞行 器 在 较为 简单 的 地 面 达到 稳定 悬 停 提供 了 可 能 。 

在 与 飞行 控制 板 连 接 时 , 光 流 有 4 个 引 脚 需要 连接 到 飞行 控制 板 上 ,分 别 是 5V 电源 
输入 .GND、TX、RX。 光 流 TX 与 飞行 控制 UART-RX 相连 ,RX 连接 UART-TX。 

如 图 4.1. 21 所 示 , 通 过 地 面 站 可 读 取 到 数值 ,确认 飞机 向 正方 向 飞行 , 光 流 输出 值 
为 负 值 ,所 以 在 进行 飞机 悬 停 校正 时 ,应 该 特别 注意 加 上 光 流 输出 的 位 移 量 的 正 负 。 光 
流 安装 与 飞行 器 正方 向 平行 ,摄像 头 对 飞机 尾部 方向 。 


飞机 飞行 Y 正 方向 


d 
飞机 飞行 YE 方向 


Y 


光 流 数据 X 负 方向 


L 光 流 数据 7 负 方向 


光 流 摄像 头 朝 下 ， 对 向 机 尾 


图 4.1.21 光 流 与 四 旋翼 飞行 器 方向 示意 图 


6. 视觉 图 像 识 别 与 跟踪 模块 

这 里 介绍 的 图 像 传感器 模块 是 在 2016 年 TI 杯 上 海 市 大 学 生 电 子 设 计 竞赛 中 用 于 
图 像 识 别 而 设计 的 ,题目 要 求 飞 行 器 能 识别 出 地 面 上 的 黑色 三 角形 、 圆 形 以 及 大 小 两 个 
正方 形 ,所 以 图 像 识别 部 分 是 基于 这 一 功能 来 阐述 的 。 当 然 读者 在 理解 了 本 小 节 内 容 之 
后 也 可 以 根据 OV2640 摄像 头 和 STM32F407ZGT6 芯片 的 特点 ,以 本 节 内 容 为 基础 编写 
代码 实现 自己 需要 的 其 他 图 像 的 识别 功能 。 

图 像 传 感 器 模块 由 ARM 芯片 STM32F407ZGT6、SRAM 芯片 IS62WV51216、 
OV2640 摄像 头 、 惯 性 导航 模块 JY-901、 电 源 模 块 . UART 串 行 接口 .LED 指示 灯 等 组 
成 ,系统 框图 如 图 4. 1. 22 所 示 。 图 像 传感器 模块 是 基于 体积 小 .重量 轻 、 功 耗 低 的 要 求 
而 设计 的 ,所 以 电路 必须 最 简化 ,而 开发 调试 的 工作 在 带 LCD 显示 屏 的 地 面 站 上 完成 。 

1) STM32F407ZGT6 简介 

STM32F407ZGT6 是 图 像 传感器 模块 的 核心 芯片 ,选用 这 款 芯 片 主要 是 因为 它 有 
8 一 14 位 54MB/s 摄像 头 DCMI 接口 ,图 像 数据 可 直接 由 DMA 采集 ,CPU 主 频 有 
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OV2640 ARM =e UARTI 接 口 


JY-901 一 一 ”UART2 接 口 


图 4.1.22 图 像 传感器 模块 框图 


168MHz, 对 特定 几何 图 像 识 别 的 处 理 速度 足够 了 。 另 外 ,该 芯片 集成 FPU 和 DSP 指 
令 , 并 具有 192KB SRAM, 1024KB Flash、12 个 16 位 定时 器 .2 个 32 位 定时 器 .2 个 
DMA 控制 器 ( 共 16 个 通道 )、3 个 SPI、2 个 全 双 工 ES.3 个 了 EC,.6 个 串口 .2 个 USB( 支 持 
主 /从 )、2 个 CAN.3 个 12 位 ADC.2 个 12 位 DAC.1 个 RTC( 带 日 历 功能 )、1 个 SDIO 
接口 1 个 FSMC 接口 .1 个 10/100M 以 太 网 MAC 控制 器 、1 个 摄像 头 接口 、1 个 硬件 随机 
数 生成 器 以 及 112 个 通用 IO 口 等 。 欲 知 详细 情况 请 查阅 STM32F407ZGT6 数据 手册 。 

2) OV2640 简介 

OV2640 摄像 头 模块 采用 1/4 英寸 的 200 万 像素 CMOS 传感器 制作 ,具有 高 灵敏 
度 .高 灵活 性 .体积 小 .工作 电压 3. 3V xc fF JPEG/RGB565 格式 输出 等 特点 。 通 过 
SCCB 总 线 控制 ,模块 尺寸 27mmX27mm, OV2640 实物 如 图 4. 1. 23 所 示 ,OV2640 R 
寸 如 图 4. 1. 24 所 示 ,OV2640 原理 图 如 图 4. 1. 25 所 示 o 


1.94mm 


图 4.1.23 OV2640 实物 4.1.24 OV2640 尺寸 
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OV2640 的 UXGA 图 像 最 高 达到 15f/s (SVGA 可 达 30f/s. CIF 可 达 60f/s)。 用 户 
可 以 完全 控制 图 像 质量 数据 格式 和 传输 方式 。 所 有 图 像 处 理 功 能 过 程 包括 y 曲线 、 白 
平衡 \ 对 比 度 、 色 度 等 都 可 以 通过 SCCB 接口 编程 。 

OV2640 的 特点 如 下 。 

CD. 高 灵敏 度 、 低 电压 适合 嵌入 式 应 用 。 

© 标准 的 SCCB 接口 ,兼容 EC 接口 。 

@ 支持 RawRGB, RGB ( RGB565/RGB555) , GRB422, YUV (422/420) 和 YCbCr 
(422) 输 出 格式 。 

@ 支持 UXGA、SXGA、SVGA 以 及 按 比 例 缩小 到 从 SXGA 到 40X30 的 任何 尺寸 。 

C 支持 自动 曝光 控制 、 自 动 增益 控制 、 自 动 白 平衡 .自动 消除 灯光 条 纹 、 自 动 黑 电 平 
校准 等 自动 控制 功能 。 同 时 支持 色 饱 和 度 、 色 相 、y 曲线 、 锐 度 等 设置 。 

© 支持 闪光 灯 。 

@ 支持 图 像 缩 放 、 平 移 和 窗口 设置 。 

@ 支持 图 像 压缩 , 即 可 输出 JPEG 图 像 数据 。 

© 自 带 嵌 人 式微 处 理 器 。 

3) 图 像 传感器 模块 硬件 简介 

四 旋翼 飞行 器 图 像 传感器 模块 基于 STM32F407ZGT6 十 OV2640 处 理 器 设计 ,5V 输 
入 经 内 部 3. 3V 稳 压 芯片 后 为 模块 供电 ,尺寸 长 . 宽 、 高 为 78mm X 59mm X 35mm, 
OV2640 用 于 采集 图 像 ,以 SCCB 接口 方式 连接 
STM32F407ZGT6 处 理 器 ,图 像 经 DMA 采集 后 存 
入 SRAM 芯片 IS62WV51216 ,图 像 经 处 理 、 识 别 后 
将 判别 结果 信息 通过 串口 传输 到 飞行 控制 板 ,从 而 
决定 飞行 器 的 飞行 动作 。 气 压 计 模块 JY-901 是 自 
带 处 理 器 的 户外 飞行 高 度 测 量 仪 , 为 了 安装 方便 ,将 
它 集成 在 图 像 传感器 电路 板 上 ,通过 串口 与 飞行 控 
制 板 相 连 。 图 像 传感器 模块 实物 如 图 4. 1. 26 所 示 。 

4) 图 像 识 别 程序 分 析 

OD 图 像 采集 

图 像 采集 流程 框图 如 图 4. 1. 27 所 示 。 因 为 处 理 器 CPU 的 大 量 时 间 耗 费 在 图 像 处 
理 和 识别 上 ,所 以 将 图 像 的 采集 工作 交 给 DMA( 直 接 内 存 访问 ) 完 成 ,DMA 是 以 提供 外 


图 4.1.26 图 像 传感器 模块 实物 
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DMA 的 双 缓 存 机 制 MOARRIS m 
MOAR( 内 部 SRAM) | 程序 读 取 

(yuva) MIAR 满 后 外 部 SRAM 和 
MIAR( 内 部 SRAM) | 程序 读 取 


图 4.1.27 图 像 采集 流程 框图 


设 和 内 存 、 内 存 和 内 存 之 间 的 高 速 数据 传输 的 ,数据 可 以 在 没有 任何 CPU 干预 下 通过 
DMA 进行 传输 。DMA 控制 器 基于 一 个 复杂 的 总 线 矩 阵 架构 ,结合 了 功能 强大 的 双 
AHB 主 总 线 架 构 与 独立 的 FIFO ,一 个 负责 内 存 访 问 , 另 一 个 负责 外 设 访问 。 

一 幅 图 像 如 果 用 内 存储 存 , 那 么 内 存 是 不 够 用 的 ,必须 将 图 像 数据 保存 在 外 部 
SRAM, 从 DMA 直接 存 外 部 SRAM 较 慢 ,图 像 数据 会 部 分 丢失 ,必须 使 用 DMA 的 双 缓 
冲 机 制 来 读 取 。DMA 接收 来 自 OV2640 的 YUV 数据 流 , 首 先 使 用 MOAR( 内 存 1) 来 存 
储 , 当 MOAR 满 了 以 后 产生 中 断 ,自动 切换 到 M1AR( 内 存 2), 同 时 程序 读 取 MOAR( 内 
存 1) 的 数据 转 存 到 外 部 SRAM; 当 MIAR 满 了 以 后 ,又 切 回 MOAR, 同 时 程序 读 取 
MI1AR( 内 存 2) 的 数据 到 外 部 SRAM; 依次 循环 ,直到 产生 帧 中 断 ,结束 一 帧 数据 的 采 
集 , 并 读 取 全 部 剩余 数据 到 外 部 SRAM ,完成 一 次 YUV 数据 的 采集 。 由 于 采用 了 双 组 
冲 机 制 ,MOAR 和 MIAR 数组 可 以 定义 得 比较 小 ,一 幅 图 像 可 以 让 MOAR 和 MI1AR 依 
次 循环 存储 多 次 直至 接收 完成 。 最 后 ,将 存储 在 外 部 SRAM 的 YUV 数据 ,经 过 二 值 化 
处 理 转 为 位 图 图 像 (YUV 图 像 一 个 像素 为 两 个 字 节 ,而 位 图 图 像 一 个 像素 为 1/8 个 字 
节 )。 该 过 程 的 主要 程序 流程 框图 如 图 4. 1. 28 所 示 。 

(2) 图 形 识别 

在 图 像 采集 函数 中 用 到 了 Figure Identify( bwimage. borderx. bordery) 函数 ,该 函数 
对 需要 识别 的 圆 形 、 三 角形 、 大 小 正方 形 先进 行 目标 框 定 , 为 防止 死 循 环 做 了 删除 断 点 区 
域 处 理 。 通 过 对 框 定 区 域内 图 形 面积 和 周 长 的 计算 来 判定 图 形 的 形状 ,并 提取 该 图 形 的 
中 心 坐 标 。 求 识别 图 形 的 面积 与 周 长 后 判别 是 什么 形状 图 形 的 计算 公式 为 
4xA 
L? 

式 中 ,L? 为 周 长 的 平方 ,是 为 了 消除 高 度 对 判别 的 影响 ; 4x 是 为 了 使 Rad 值 归 一 化 。 根 
据 Rad 值 的 范围 可 判别 是 什么 形状 图 形 。 


Rad 一 


(4.1.1) 
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初始 化 OV2640 摄 像 头 
模块 及 RGB 模式 
i 


申请 各 类 图 像 
处 理 缓存 


i 


初始 化 DCMI 
接口 配置 


配置 DCMI DMA 
双 缓冲 模式 


开始 DMA 搬 运 


停止 DMA 搬 运 


图 像 二 值 化 处 理 


像 识别 


口 发 送 识别 
结果 


图 4.1.28 图 形 处 理 程序 流程 框图 


(D Rad>0.86 则 判定 为 圆 形 。 

@ 0.65 二 Rad 志 0. 86” 则 判定 为 正方 形 。 

@ Rad<0. 65 则 判定 为 三 角形 。 

此 函数 图 形 识 别 程序 设计 流程 框图 如 图 4. 1. 29 所 示 。 


Pd 
A 
T 
[3 
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删除 断 点 ， 计 算 
图 形 周 长 


计算 Rad=4rd/Z2 


Rad>0.86 .65«Rad «0.86 Rad 0.6: 
Y 


Y Y 
判断 为 圆 形 判断 为 正方 形 判断 为 三 角形 
并 置 标志 位 并 置 标志 位 并 置 标志 位 
Y Y Y 
更 新 圆 形 的 中 心 | | 更 新 正方 形 的 中 更 新 三 角形 的 中 
坐标 和 面积 心 坐 标 和 面积 心 坐标 和 面积 


图 4.1.29 图 形 识别 程序 设计 流程 框图 

一 个 图 形 被 采集 后 ,处理 生成 一 个 二 值 化 图 像 矩 阵 ( 其 中 ,图 形 部 分 全 为 白 ,背景 部 
分 为 黑 ,为 了 便于 分 析 , 将 图 形 部 分 每 个 点 都 用 1 表示 ,背景 点 用 0 表示 )。 在 对 待 识别 
图 形 目标 框 定 后 ,面积 的 计算 只 要 数 “1? 的 个 数 即 可 , 周 长 的 计算 需要 搜索 出 图 形 的 轮 
廊 , 就 是 要 把 二 值 矩阵 里 的 “1 的 路 径 找到 。 采 取 从 左 到 右 \, 从 上 到 下 的 扫描 顺序 搜索 轮 
廓 的 第 一 个 点 。 按 此 种 扫描 方式 ,本 书 按 逆 时 针 的 方向 (也 可 用 顺 时 针 , 算 法 类 似 ) 搜 索 
轮廓 。 设 轮廓 第 一 点 在 此 3X3 模板 的 0 位 置 ,那么 第 二 点 只 可 能 从 1 位 置 开 始 搜索 ,而 
不 可 能 出 现在 5.6.7、8 位 置 。 那 么 在 剩 下 的 1.2.3、4 位 置 上 肯定 能 找到 第 二 个 轮廓 点 。 
至 此 ,轮廓 的 第 一 点 和 第 二 点 找到 。 本 书 便 可 以 提出 沿 外 法 线 方向 搜索 下 一 个 轮廓 点 进 
而 搜索 出 整个 图 形 轮廓 。 用 外 法 线 方法 搜索 整个 轮廓 的 好 处 是 : 可 以 沿 着 图 形 的 边沿 把 
每 一 个 “1” 值 点 都 快速 找到 而 不 用 去 搜索 Xe 八 邻 点 的 每 一 点 。 还 避免 了 搜索 出 的 图 形 
轮廓 变形 ,如 按 指定 位 置 搜索 轮廓 点 会 把 图 形 内 部 的 “1” 值 点 误 认 为 轮廓 点 。 

算法 如 图 4. 1. 30 和 图 4. 1. 31 所 示 ,实现 如 下 。 

CD 按 从 上 到 下 从 左 到 右 的 顺序 扫描 二 值 矩 阵 , 得 到 第 一 个 轮廓 点 ,将 它 的 行列 坐标 
存 人 轮廓 数组 ,数组 指针 加 1。 
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yL 7 6 5 
y” 8 0 4 
X 1 2 3 
图 4.1. 30 法 线 方向 图 4.1.31 模板 各 点 编号 


© 令 第 一 点 在 此 3X3 模板 的 0 位 置 ,在 第 二 点 可 能 的 1.2、3、4 位 置 上 扫描 ,找到 第 
二 个 轮廓 点 ,将 它 的 行列 坐标 存 人 轮廓 数组 ,数组 指针 加 1 。 

@ 根据 前 两 个 搜索 到 的 轮廓 点 , 设 这 两 点 为 Xe 和 Xi ,Xe 始终 置 于 3X3 模板 的 中 心 
0 位 置 。 搜 索 下 一 个 轮廓 点 ,对 应 到 模板 的 编号 ,如 果 Xi, 在 1 位 置 ,那么 下 一 个 轮廓 点 的 
搜索 应 从 7 位 置 开 始 ,在 此 模板 中 心 的 八 邻 点 中 , 沿 道 时 针 方向 搜索 出 值 为 “1 的 图 形 
HA fig, 1, 72,00, BBO 3, D,C0, 4, 25,00, 5, 3,(0, 6, 4),C0, 7, 5), 
(0, 8, 60 ,括号 里 的 前 两 个 数字 表示 Xo 与 Xi 的 位 置 ,后 一 个 数字 表示 外 法 线 方向 的 搜索 
开始 位 置 。 把 搜索 到 的 这 个 轮廓 点 的 行列 坐标 存 人 数组 ,数组 指针 加 1。 如 果 找 到 的 这 
个 点 与 第 一 个 轮廓 点 的 行列 坐标 相同 , 即 表示 搜索 回 到 了 起 点 ,整个 轮廓 已 搜索 出 ,该 算 
法 结束 ; 否则 ,继续 转 入 @ 。 

计算 周 长 = 偶 数 链 码 X1 十 奇数 链 码 X1.414。 在 轮廓 搜索 的 过 程 中 ,根据 轮廓 已 经 
将 链 码 分 为 奇偶 链 码 ,两 点 相距 为 1 个 单位 时 为 偶 链 码 ,两 点 相距 为 V2 个 单位 时 为 奇 链 
码 , 用 上 公式 便 可 求 出 周 长 。 

7. 航拍 视频 传输 模块 

具有 视觉 功能 的 四 旋翼 飞行 器 有 很 多 用 途 , 这 里 讨论 一 种 简单 的 飞行 器 采集 和 发 送 
视频 图 像 的 方法 ,并 用 手机 显示 图 像 ,系统 总 体 框架 图 如 图 4. 1. 32 所 示 。 

为 了 图 像 能 实时 显示 ,视频 图 像 采 集 和 传输 使 用 WR703N 无 线路 由 器 ,在 OpenWrt 
的 嵌入 式 Linux 系统 下 进行 程序 开发 。 用 舵 机 云 台 使 得 摄像 头 可 以 分 别 在 两 个 自由 度 
上 进行 180° 的 转动 。 

1) 硬件 构成 与 选择 

要 想 实现 无 人 机 航拍 并 将 视频 实时 传输 这 一 功能 ,摄像 头 与 传输 方式 的 选择 至 关 重 
要 。 考 虑 到 要 将 航拍 功能 应 用 于 四 旋 辟 飞行 器 上 ,而 飞行 器 的 有 效 载荷 有 限 , 因 此 应 选 
用 体积 较 小 的 、 空 间 利用 率 高 的 WiFi 发 射 装置 。 
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Android | WiFi 通 信 | WR703N . 
手机 端 [7 一 | 无 线路 由 器 厂 一 一 一 | 免 驱 摄像 头 
Dmm 
光 流 MPU9150 
传感器 | “| 九 轴 传感器 
TM4C123GH6PM 
超声 让 MISMA 电源 电压 
传感器 7] 测量 模块 
电机 WERL | 


图 4.1.32 系统 总 体 框架 图 


经 调查 对 比 ,本 设计 采用 WR703N 无 线路 由 器 作为 WiFi 信号 发 射 器 。 它 不 仅 体 积 小 、 
集成 度 高 .利于 安装 固定 ,而 且 在 软件 部 分 采用 了 开源 的 OpenWrt, 程 序 编写 灵活 简单 。 

同样 可 以 刷 写 OpenWrt 固件 的 无 线路 由 器 还 有 WR720N, 以 下 从 各 方面 对 两 者 进 
行 比较 。 

(D 两 者 均 有 32MB 的 RAM 和 4MB 的 闪存 。 

@ TL-WR720N 有 两 个 网 线 接 口 ,可 以 通过 有 线 外 接 台 式 机 ,而 且 有 内 置 电池 ,可 以 
给 一 些 移动 终端 供电 , 但 不 能 给 和 白 身 供电 。 不 过 可 以 用 外 置 电 池 供 电 使 用 。 
TL-WR703N 只 有 一 个 网 线 接口 。 

@ 二 者 均 支 持 3G 功能 ,并 且 最 高 传输 速率 都 是 150Mb/s。 

@ 网 络 接口 。 两 者 LAN/WAN 复 用 接口 的 速 
率 相同 ,都 可 以 达到 10/100Mb/s, 但 WR703N 只 有 
一 个 复 用 接口 。 

© WR703N 个 头 比 WR720N 小 巧 得 多 ,质量 也 
很 轻 。 

© WR720N 有 时 等 待 识别 需要 很 长 时 间 。 

综合 上 述 各 种 因素 考虑 ,本 设计 最 终 选择 
WR703NN 无 线路 由 器 作为 WiFi 信号 发 生 装置 ,实物 
如 图 4. 1. 33 所 示 。 其 中 ,电源 由 电 调 供电 ,USB 接 
口 连接 摄像 头 ,3 根 导 线 接 出 来 的 接头 连接 飞行 控制 


I 


P 


E] 4.1.33. WR703N 路 由 器 
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板 ,进行 串口 通信 。 
2) OpenWrt 的 使 用 
(D OpenWrt 固件 刷 写 


刚 买 来 的 WR703N 无 线路 由 器 并 不 能 直接 使 用 ,要 对 其 进行 OpenWrt 固件 的 刷 写 


CD 找到 “本 地 连接 属性 "对话 框 ,对 “Internet 协议 版 本 4(TCP/IPv4) 属 性 ”进行 正 
确 的 配置 ,如 图 4.1. 34 所 示 。 


Correr 


6 QUERI rr eto 
S RATEN 11 MOD. 
m Wto: 


z 网 总 的 文件 和 打印 机 共 于 
E Toterset DEEE 6 OH I) 
Em 


[Tr miam Cmm m 1m] 


Fl 4.1.34. “本 地 连接 属性 "界面 ( 左 ) 和 ”Internet 协议 属性 "界面 ( 右 ) 


@ 将 烧 写 的 固件 放 入 Tftp32 文件 夹 内 ,如 图 4.1. 35 所 示 。Tftp32 相当 于 一 个 多 功 
能 的 网 络 服务 器 包 , 主 要 用 于 不 同 服务 器 间 的 资源 传输 。 


OOE, HEN, swan D > Design + asking ESI 


EE pasz 


[rr 可 
09 z 


4.1.35. 放置 固件 到 目的 路 径 
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© 在 计算 机 与 路 由 器 之 间 用 网 线 和 TTL 线 连 接 , 登 录 Putty, 如 图 4. 1. 36 所 示 。 
Putty 是 一 款 在 Windows 平台 下 访问 Linux 系统 的 软件 。 


Category: 
E Session. Basic options for your PuTTY session. 
` Logging 
4 Specfy the destination you want to connect to 
€— Serial ine Speed 
| Cos CDM 115200 
| L Features Connection type: 
-Wrdow ORm CO Tene C Regn OSSH @ Seral 
LL. Load, save or delete a stored session. 
| - Translation Saved Sessions 
| Selecion ] 
“Colours Defaut Settings 
E Connection Eee 
E ee 
Bos [osae ] 
Rogn 
& SSH 
E ea: 
C Away ©Never  @ Ony on dean ext 


图 4.1.36 使 用 Putty 登录 


@ 对 系统 进行 适当 的 配置 即 可 完成 固件 刷 写 ,OpenWrt 的 启动 界面 如 图 4. 1. 37 所 
示 。 软 件 SercureCRT 功能 与 Putty 相似 。 


BusyBOX v1.19.4 (2014-03-17 04:29:05 PDT) built-in shell (ash) 
Enter 'help' for a list of built-in commands. 


—| II 885:ww. wif i-robots.com 
zn | by liuviking 


Base on OpenWrt-DreamBox (PandoraBox, r737) 
ootéDr eambox :~# 


pi 
um Ssh2-AES-256-CTR 24, 18 24 和 ,80 列 VT100 


图 4.1.37 OpenWrt 启动 界面 
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OpenWrt 是 一 个 集成 化 的 Linux 系统 ,在 功能 上 有 很 好 的 扩展 性 ,可 进行 挂 在 U 
盘 、 串 口 透 传 .智能 家 居中 继 转 发 等 应 用 开发 。 它 包含 了 上 千 个 功能 包 , 也 提供 了 很 多 
已 经 编译 好 的 软件 供 使 用 。 与 普通 发 行 版 路 由 器 不 同 的 是 ,OpenWrt 是 一 个 从 无 到 有 、 
配置 灵活 ,使 用 简便 、 功 能 多 样 的 完全 开源 的 Linux 发 行 版 。 

(2) 备份 安装 bin 文件 ee :- cat /proc/mtd 


lev: size  erasesize name 


(D H Putty 进入 路 由 以 后 ,输入 cat /proc/mtd medo: 00020000 00010000 " deme 


mtd2: 002ee42c 00010000 " 
查看 分 区 状况 。 里 面 说 明了 各 个 分 区 的 内 容 ,如 — DEOS: QoosoQ0Q 90019000 "rotis. data" 
mtd: 00340000 00010000 "firmware" 
图 4.1.38 所 示 。 
至 于 firmware 分 区 , 则 是 包含 了 所 有 的 kernel 
和 rootfs 以 及 rootfs_data 和 art, 如 表 4. 1.5 所 示 。 


图 4.1.38 分 区 情况 


表 4.1.5 分 区 情况 说 明 


分 区 名 称 描 述 
u-boot 设备 初始 化 程序 十 引导 程序 代码 本 身 
Yernel 内 核 ,顾名思义 是 一 个 系统 的 最 核心 部 分 ,存放 的 都 是 对 内 核 进行 管理 的 核心 信息 ， 
这 些 信 息 都 是 以 二 进 制 形式 存放 的 
rootfs 完整 的 系统 文件 包含 只 读 和 可 写 
rootfs_data 在 rootfs 中 的 可 写 部 分 的 位 置 ,为 配置 文件 所 在 区 ,rootfs_data 相当 于 /overlay 
art EEPROM 分 区 ,在 Atheros 方案 中 这 个 分 区 保存 了 无 线 的 硬件 参数 


firmware 完整 的 固件 位 置 包含 了 除 u-boot 和 art 之 外 全 部 的 内 容 


@ 输入 以 下 几 行 命令 就 可 以 备份 整个 . bin 格式 的 back. firmware 文件 了 ,如 图 4. 1. 39 
所 示 。 

root(àDreambox:-- # cd /tmp 

root(àDreambox:/tmp£ dd if = /dev/mtd5 of = /tmp/back firmware.bin 


7808 + 0 records in 
7808 * 0 records out 


rootéDreambox:/tmp& ls 


resolv.conf sysinfo 
back firmware.bin Ld resolv.conf.auto 
dhcp. leases run 
etc . ` ec state 


图 4.1.39 文件 备份 目录 


© 通过 WinSCP 传 到 Windows 系统 ,如 图 4. 1. 40 所 示 。WinSCP 是 不 同系 统 之 间 
文件 传输 处 理 的 工具 。 
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[L back firmware.bin 2014/3/17 HR. BIN 文件 3,904 KB] 


图 4.1.40 备份 文件 显示 
(3) 编译 一 个 Hello World 程序 
(D 在 Ubuntu 下 ,新 建 名 为 hello world. ec 文 件 ,编写 相应 的 程序 : 
vi hello world.c 


@ 输入 以 下 内 容 : 


# include < stdio.h» 
int main(char argc, char * argv[]) 
( 


inti = 1; 
while(1)( 
printf("Hello world!!! % d\n", i); 
if(i<10) 
itt; 
else 
i-1; 
sleep(1); 
) 
return 0; 


j 
© 用 mips 48 4 4i iE “hello_world. c”" 文 件 ,并 生成 “hello_world” 可 执行 文件 mip- 


openwrt-linux -gcc hello world. c -o hello world, 
@ 用 WinSCP 将 文件 传输 到 /tmp 目录 下 。 
© 在 开发 板 的 串口 终端 下 执行 “hello_world" 文 件 : 


/tmp/hello world 


(4). 交叉 编译 并 生成 IPK 文件 

在 嵌入 式 开发 过 程 中 学 会 使 用 交叉 编译 的 方法 是 十 分 必要 的 。 交 叉 编 译 通 常用 于 
两 个 有 不 同 控制 语言 的 平台 之 间 , 先 在 A 台 机 器 上 对 程序 进行 编译 ,生成 可 执行 文件 ,再 
将 可 执行 文件 转移 到 B 机 器 上 来 运行 。 起 初 要 从 官网 上 下 载 交 又 编译 工具 链 并 进行 安 
装 ,工具 链 通常 包括 编译 器 .连接 器 、 解 释 器 和 调试 器 4 个 部 分 。 
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(D 切换 到 openwrt 根 目 录 ,执行 下 列 命令 : 


cd. /package/utils //3 X package/utils 目录 

nkdir hello world // 创 建 一 个 名 为 "hello_world" 的 文件 夹 , 用 于 放置 安装 包 源 码 
cd hello world // 进 入 相应 文件 夹 

mkdir src // 新 建 一 个 名 为 "src" 的 文件 夹 

vi src/hello world.c // 在 src 目录 下 新 建 一 个 名 为 hello_world.c 文件 ,内 容 同 上 


© 在 src 目录 下 新 建 一 个 Makefile, 输 入 相应 的 内 容 : 
vi src/Makefile 


@ 在 当前 目录 下 新 建 一 个 Makefile 文件 并 进行 编写 。Makefile 如 同 脚 本 文件 ,其 
中 定义 编写 了 一 系列 系统 需要 执行 的 操作 命令 。 
@ 返回 至 openwrt LHK ,执行 命令 : 


make menuconfig 
选择 已 经 加 进去 的 安装 包 : 


utilities - - -< 

«M» hello world... Hello world - prints a hello world message 

© make V=s。 等 待 编 译 完 成 后 ,可 以 在 openwrt 目录 下 的 base 文件 夹 内 找到 生成 
的 安装 包 */hello_world_1.0_ar71xx.ipk”。 

© 将 ipk 包 传 输 与 安装 到 开发 板 上 即 可 运行 。 

更 改 权 限 root(9 Dreambox: / € chmod u+x /tmp/hello world 。 

运行 结果 如 图 4. 1. 41 所 示 。 


root@Dreambox:/#  /tmp/hello world 
Hello world!'!1 

Hello world!! H 

Hello world 
Hello world!!!4 
Hello world!!!5 
Hello world!!!6 


图 4.1.41 Hello World 运行 结果 
(5) OpenWrt 高 级 功能 


除了 基本 的 Hello World 程序 的 运行 ,OpenWrt 这 个 嵌入 式 Linux 系统 还 有 很 多 高 
级 功能 可 以 拓展 ,下 面 介绍 其 中 3 种 模式 。 
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O AP 模式 。 接 人 点 模式 ,可 以 不 用 设置 SSID 和 密码 ,关闭 DHCP 服务 器 ,外 设 通 
过 WiFi 连接 开发 板 。 

Q Router。 路 由 器 模式 , 需 输 入 SSID 和 密码 才 可 以 进入 ,开启 DHCP 服务 器 ,外 设 
通过 WiFi 连接 开发 板 。 

@ 二 级 无 线路 由 器 模式 设置 。 开 启 DHCP 服务 器 ,连接 开发 板 的 设备 和 上 级 路 由 
器 处 于 不 同 网 络 ,一 般 不 能 互通 。 

3) OpenWrt 挂 载 摄像 头 

要 实现 视频 传输 必须 要 安装 相关 功能 的 IPK, 如 表 4. 1.6 所 示 。 


表 4.1.6 视频 传输 相关 IPK 介绍 


IPK 名 称 描 Æ 
kmod-video-core 摄像 头 内 核 模 块 ,UVC 驱动 依赖 包 
kmod-video-videobuf2 UVC 驱动 依赖 包 
kmod-video-uve UVC 驱动 
libpthread mjpeg-streamer 依赖 包 
libjpeg mjpeg-streamer 依赖 包 
mjpg-streamer mjpeg-streamer 功能 安装 包 


插入 摄像 头 ,根据 系统 打印 信息 判断 开发 板 是 否 支持 该 型 号 的 摄像 头 ,必须 选择 
UVC 摄像 头 。 在 安装 完 摄像 头 之 后 会 出 现 */etc/config/mjpg-streamer” 配 置 文件 ,如 
图 4. 1. 42 所 示 。 


config mjpg-streamer core 
option enabled "o" 
option device "/dev/videoO" 
option resolution "640x480" 
option fp: "5" 
option www " /www/webcam" 
option port "8080" 


图 4.1.42. mjpg-streamer 文件 内 容 


文件 中 的 内 容 分 别 配置 了 设备 名 称 、 摄 像 头 的 分 辩 率 、 帧 率 、 访 问 目录 与 访问 端口 。 
在 连接 上 路 由 器 发 射 的 WiFi 信号 之 后 ,用 浏览 器 打开 网 址 http://192. 168. 1. 1:8080/? 
action 一 stream, 即 可 看 到 实时 传输 的 视频 。 


4.1.3 遥控 器 介绍 


当前 最 常用 的 遥控 器 是 2. 4GHz 频段 的 遥控 器 ,常见 的 有 天 地 飞 、 富 斯 等 品牌 ,遥控 
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器 握 持 在 使 用 者 的 手中 ,无 线 或 通过 信号 线 连接 至 地 面 站 ,经 地 面 站 处 理 将 PPM 信号 并 
解析 成 真正 的 适 控 数据 ,实现 还 控 器 对 四 旋翼 飞行 器 的 控制 。 而 接收 机 安装 在 四 旋 避 飞 
行 器 机 身上 以 接收 发 射 机 的 信号 ,并 且 将 各 个 通道 的 数据 用 PWM 波 的 形式 输送 到 四 旋 
翼 飞 行 器 对 应 的 接收 引 脚 。 

若 使 用 遥控 器 与 对 应 接收 机 进行 飞行 操控 ,需要 注意 以 下 细节 。 

CD 使 用 前 需要 进行 对 码 。 

© 由 于 2.4 GHz 是 全 球 免 费 频段 ,因此 为 了 防止 多 个 遥控 器 之 间 的 互相 干扰 ,在 使 
用 前 通常 需要 进行 发 射 机 和 接收 机 的 对 码 操作 。 具 体 来 说 , 则 是 接 通 接收 机 和 发 射 机 电 
源 之 后 进行 的 一 系列 操作 ,以 便 使 接收 机 和 发 射 机 之 间 存 在 信号 的 验证 ,避免 干扰 。 接 
收 机 通常 接 到 5V 的 电源 上 。 

© 发 射 机 通道 及 反 向 设置 。 

@ 当前 的 遥控 器 一 般 至 少 是 6 通道 。 而 通道 数量 的 多 少 和 误 码 率 等 也 是 选择 遥控 
器 的 标准 。 四 旋 姥 飞行 器 至 少 需要 4 个 通道 , 剩 下 的 通道 主要 用 于 控制 相机 、 云 台 以 及 
其 他 设备 。 

Futaba T6j 遥控 器 包括 一 台 6 通道 的 Futaba 6j 发 射 机 和 一 个 2. 4GHz 的 R2006GS 
高 压 接 收 机 ,发射 机 和 接收 机 通过 内 置 序列 号 相 匹配 ,一 台 发 射 机 只 能 对 一 个 特定 的 接 
收 机 发 射 信号 。 一 般 地 ,控制 4 轴 的 4 个 通道 是 在 发 射 机 的 摇 杆 上 面 ,而 其 他 的 通道 往 
往 以 旋钮 或 者 拨 动 开关 的 形式 放 在 遥控 器 面板 的 上 方 。 

根据 摇 杆 与 通道 的 配置 关系 ,发 射 机 可 以 分 为 "左手 油门 (美国 手 )” 与 “右手 油门 (日 
本 手 )” 两 种 ,如 图 4. 1. 43 所 示 ,左边 为 日 本 手 ,右边 为 美国 手 。 


升降 舵 


Ele/Pit BEHE DU e M Thr 加 减 油门 E898 le 
. 1 - - [4 * N, 
Jie Es e" | d 3. £e 
Rud - " 
Lr 
Yaw n 
Ail 


日 本 手提 探 方式 euren 


图 4.1.43 常用 2.4GHz 航模 遥控 器 各 通道 示意 图 


第 4 章 “四 旋 届 飞行 器 硬件 系统 设计 > 95 


一 般 认为 ,日 本 手 由 于 两 手 分 开 控制 Rol/Pit 这 两 个 最 重要 的 姿态 量 ,比较 适 合 航拍 
和 新 手 使 用 ,而 美国 手 更 适合 固定 沟 。 

Futaba 6j 发 射 机 通道 及 功能 如 下 。 

CD 油门 通道 、. 舵 向 通道 ( 偏 航 )、 副 辟 通 道 (翻滚 ) 和 升降 通道 (俯仰 ) ,这 4 个 通道 用 来 
控制 四 旋 避 飞行 器 的 飞行 姿态 。 其 中 油门 通道 和 舵 向 通道 集成 在 一 起 , 副 翼 通道 和 升降 
通道 集成 在 一 起 ,分 别 由 一 个 两 自由 度 调 节 杆 控制 。 每 个 通道 对 应 一 个 微调 旋钮 ,通过 
微调 各 通道 ,可 以 使 遥控 器 工作 在 最 佳 状态 。 

@ 第 五 通道 为 一 个 两 段 式 开 关 , 有 高 、 低 两 种 状态 ,第 六 通道 为 一 个 旋钮 式 开 关 , 由 
低 到 高 可 调 。 通 过 调节 这 两 个 开关 ,结合 GUI 设置 ,可 实现 四 旋翼 飞行 器 如 定 高 .定点 、 
自动 返航 等 不 同 飞行 模式 。R2006GS 高 压板 接收 机 是 1. 4GHz 的 无 线 接收 器 ,其 有 两 根 
天 线 ,两 根 天 线 末 端 尽量 保持 垂直 关系 ,以 便 更 好 地 接收 无 线 信 号 。 
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4.2.1 机 架 结 构 与 设备 安装 


机 架 是 安装 前 文中 所 述 各 个 部 分 的 重要 载体 , 某 种 程度 上 也 将 影响 四 旋 愤 飞行 器 的 
性 能 。 较 大 四 旋翼 飞行 器 的 机 架 一 般 采 用 金属 或 者 玻璃 纤维 和 工程 塑料 制作 ,而 微型 四 
旋 收 飞行 器 的 机 架 一 般 采 用 PCB 直接 充当 。 

较 大 四 旋翼 飞行 器 的 机 架 一 般 可 以 自己 动手 做 ,主要 分 为 中 心 板 `. 四 臂 . 电 机 固定 座 
以 及 起 落架 等 部 分 ,如 图 4. 2. 1 所 示 。 

中 心 板 是 机 架 的 核心 ,用 于 固定 四 旋翼 飞行 器 的 四 臂 。 同 时 ,一 般 上 面 会 有 间隔 
45mmX 45mm 的 安装 孔 用 于 安装 飞行 控制 板 。 一 般 情 况 下 ,中心 板 有 两 层 ,而 四 臂 通过 
中 心 板 上 的 固定 螺栓 夹 到 两 层 中 心 板 的 中 间 。 四 臂 的 未 端 ,一 般 有 电机 座 固 定 螺 孔 和 起 
落架 固定 螺 孔 。 这 里 用 的 通常 是 直径 为 3mm 的 长 螺杆 螺钉 。 安 装 时 需要 注意 以 下 一 些 
细节 。 

(D 拧 螺钉 要 紧 一 点 ,维持 较 好 的 机 架 机 械 强 度 ; 因为 四 旋 辟 飞行 器 的 四 臂 外 形 会 影 
响 其 力学 特性 。 

© 飞行 控制 板 安装 的 时 候 要 放 乎 ,有 些 飞行 控制 系统 在 起 飞 前 检查 水 平 位 置 ,并 且 
飞行 控制 系统 应 该 尽量 放置 在 四 旋翼 飞行 器 机 架 的 中 心 位 置 。 
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固定 螺 孔 


飞行 控制 板 安装 孔 分 布 在 
45mmX45mm 矩 形 
的 4 个 角 上 


图 4.2.1 机 架 结构 


© 电池 要 绑 稳定 ,也 应 尽量 靠近 中 间 位 置 ,以 便 保 持 较 好 的 重心 结构 。 

由 于 对 重量 的 要 求 较 高 ,微型 四 旋翼 飞行 器 的 机 架 通常 可 以 直接 用 自身 的 PCB 充 
当 , 或 者 是 用 碳纤维 .工程 塑料 等 比较 轻 且 比较 坚固 的 材料 加 上 比较 小 的 PCB 构成 。 使 
用 PCB 作为 机 架 时 ,可 以 选择 比较 薄 的 PCB, 如 0. 8mm 厚度 ,这 样 能 降低 重量 。 同 时 ， 
PCB 本 身 可 以 设计 成 机 架 的 样子 ,将 中 心 板 、 四 臂 、 电 机 安装 座 都 包含 在 内 。 


4.2.2 电机 与 桨 的 选用 


四 旋 潜 飞行 器 的 控制 ,关键 在 于 姿态 控制 ,控制 电机 转速 是 最 后 的 一 步 。 电 机 作为 四 
旋 潜 飞行 器 控制 的 最 终 执行 部 件 , 对 四 旋翼 飞行 器 姿态 的 调节 起 到 直接 的 作用 。 选 择 无 刷 
电机 的 时 候 , 有 以 下 一 些 数据 是 需要 注意 的 。 图 4. 2. 2 所 示 为 新 西 达 出 品 的 一 款 无 刷 电 机 。 


图 4.2.2 新 西 达 2212 无 刷 电机 
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1. RT 

无 刷 电 机 在 型 号 命名 上 就 反映 了 其 具体 大 小 。 例 如 ,常用 的 新 西 达 2212 电机 ,含义 
就 是 ,直径 为 22mm, 转 子 的 高 度 为 12mm。 一 般 而 言 , 越 大 的 电机 其 转速 和 扭力 也 就 
越 大 。 

2. KV 值 

无 刷 电机 KV 值 定义 为 “转速 /V”, 意 思 为 当 输入 电压 增加 1V 时 ,无 刷 电机 空转 转 
速 增加 的 转速 值 。 例 如 ,KV1000 的 无 刷 电机 ,代表 电压 为 11V 的 时 候 , 电 机 的 空转 转速 
为 11000r/min, KV 值 越 大 ,速度 越 快 ,但 扭力 越 小 ; KV 值 越 小 ,速度 越 慢 ,但 扭力 越 
大 。450 一 600mm 轴 距 ,2kg 左右 的 四 旋翼 飞行 器 ,一 般 采 用 新 西 达 2212-KV1000 电机 
搭配 1045 螺旋 桨 就 可 以 了 。 

电机 碳 侧 为 固定 座 , 用 于 将 电机 固定 到 机 架 上 面 ; 子弹 头 用 于 安装 螺旋 桨 ; 电机 上 
的 3 根 线 , 即 右边 示意 图 与 电 调 连接 的 电机 驱动 线 。 如 果 调 换 其 中 任意 两 根 的 位 置 , 则 
电机 的 转动 方向 将 会 发 生变 化 。 转 动 方向 与 正 反 桨 的 转动 方向 及 搭配 非常 重要 ,因此 安 
装 时 一 定 要 注意 。 安 装 完毕 后 ,4 个 螺旋 桨 吹 起 的 风 应 该 都 是 向 下 的 。 

电机 与 螺旋 桨 的 搭配 是 非常 复杂 的 问题 ,螺旋桨 越 大 ,升力 越 大 ,但 需要 更 大 的 扭力 
来 驱动 ; 螺旋 桨 转速 越 高 ,升力 越 大 ; 电机 的 KV 值 越 小 ,扭力 越 大 。 因 此 大 螺旋 桨 需要 
低 KV 值 的 电机 ,小 螺旋 架 需 要 高 KV 值 的 电机 。 如 果 高 值 的 电机 带 大 桨 ,扭力 不 足 , 那 
么 电机 和 电 调 就 很 容易 烧 掉 ; 如 果 低 KV 值 的 电机 带 小 桨 ,电机 电 调 没 大 问题 ,但 产生 的 
升力 严重 不 足 , 可 能 无 法 起 飞 。 因 此 ,需要 通过 大 量 试验 才能 得 出 电机 与 螺旋 桨 的 搭配 
关系 。 仍 然 以 新 西 达 2212-1000K V. 电机 为 例 , 通 常 可 搭配 1045 桨 使 用 。1045 的 含义 
是 ,螺旋 桨 的 直径 是 10 英寸 (lin 王 2. 54cm) , 螺 距 是 4.5 英寸 。 也 就 是 说 ,螺旋 桨 每 旋转 
一 圈 前 进 4. 5 英寸 。 实 际 使 用 中 还 可 以 使 用 三 叶 螺旋 桨 等 。 
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5.1 开发 工具 简介 


5.1.1 CCS 


CCS( Code Composer Studio) 是 TI 公司 研发 的 一 款 具 有 环境 配置 、 源 文件 编辑 、 
程序 调试 .跟踪 和 分 析 等 功能 的 集成 开发 环境 ,能 够 帮助 用 户 在 一 个 软件 环境 下 完 
成 编辑 .编译 、 链 接 .调试 和 数据 分 析 等 工作 。 当 前 的 最 新 版 本 为 CCSv6 , 它 具 有 以 
下 特点 。 

(D Windows 下 工作 ,类 似 于 Visual C++ 的 集成 开发 环境 。 

© 采用 图 形 接口 界面 ,有 编辑 工具 和 工程 管理 工具 。 

© 它 将 汇编 器 、 链 接 器 .C/C++ 编译 器 、 建 库 工具 等 集成 在 一 个 统一 的 开发 平台 中 。 

@ CCS 所 集成 的 代码 调试 工具 具有 各 种 调试 功能 ,能 对 TMS320 系列 DSP 进行 指 
令 级 的 仿真 和 可 视 化 的 实时 数据 分 析 。 

© 丰富 的 输入 输出 库 函 数 和 信号 处 理 库 函 数 。 

© CCS C5000 是 专门 用 来 开发 C5000 系列 DSP 系统 (C54x 和 C55x) 的 平台 。 


5.1.2 IAR 


IAR 的 Embedded Workbench 系列 是 一 种 增强 型 一 体 化 嵌入 式 集成 开发 环境 ,其 中 
完全 集成 了 开发 嵌入 式 系统 所 需要 的 文件 编辑 项 目 管理 、 编 译 、 链 接 和 调试 工具 。IAR 
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公司 独 具 特 色 的 C-SPY 调试 器 ,不 仅 可 以 在 系统 开发 初期 进行 无 目标 硬件 的 纯 软 件 仿 
真 , 也 可 以 结合 IAR 公司 推出 的 J-Link 硬件 仿真 器 ,实现 用 户 系统 的 实时 在 线 仿真 
调试 。 

IAR 的 Embedded Workbench 系列 适用 于 开发 基于 8 位 、16 位 以 及 32 位 微 处 理 器 
的 戏 入 式 系统 ,其 集成 开发 环境 具有 统一 界面 ,为 用 户 提供 了 一 个 易学 易 用 的 开发 平台 。 
IAR 公司 提出 了 “不 同 架 构 , 唯 一 解决 方案 ”的 理念 ,用 户 可 以 针对 多 种 不 同 的 目标 处 理 
器 ,在 相同 的 集成 开发 环境 中 进行 基于 不 同 CPU 的 嵌入 式 系统 应 用 程序 开发 ,有 效 提 
高 工作 效率 ,节省 工作 时 间 。IAR 的 Embedded Workbench 系列 还 是 一 种 可 扩展 的 模 
块 化 环境 ,允许 用 户 采 用 自己 喜欢 的 编辑 器 和 源 代码 控制 系统 ,链接 定位 器 (XLINK) 
可 以 输出 多 种 格式 的 目标 文件 ,使 用 户 可 以 采用 第 三 方 软件 进行 仿真 调试 和 芯片 
编程 。 


5.1.3 Keil 


Keil 公司 是 一 家 业界 领先 的 微 控制 器 (MCU) 软 件 开发 工具 的 独立 供应 商 。Keil 公 
司 由 两 家 私人 公司 联合 运营 ,分 别 是 德国 慕尼黑 的 Keil Elektronik GmbH 和 美国 德 克 萨 
斯 的 Keil Software Inc, Keil 公司 制造 和 销售 种 类 广泛 的 开发 工具 ,包括 ANSI C 编译 
器 ` 宏 汇编 程序 .调试 器 .连接 器 . 库 管 理 器 .固件 和 实时 操作 系统 核心 (Real-time 
Kernel), 。 有 超过 10 万 名 微 控制 器 开发 人 员 在 使 用 这 种 得 到 业界 认可 的 解决 方案 。 其 
Keil C51 编译 器 自 1988 年 引入 市 场 以 来 成 为 事实 上 的 行业 标准 ,并 支持 超过 500 种 
8051 变种 。 

Keil 公司 2005 年 由 ARM 公司 收购 。 而 后 ARM Keil 推出 基于 i Vision 界面 ,用 于 
调试 ARM7、ARM9、Cortex-M 内 核 的 MDK-ARM 开发 ,作为 控制 领域 的 开发 工具 。 

2009 年 2 月 发 布 Keil wVision4, 它 引入 灵活 的 窗口 管理 系统 ,使 开发 人 员 能 够 使 用 

台 监 视 器 ,并 提供 了 视觉 上 的 表面 对 窗口 位 置 的 完全 控制 的 任何 地 方 。 新 的 用 户 界面 

可 以 更 好 地 利用 屏幕 空间 和 更 有 效 地 组 织 多 个 窗口 ,提供 一 个 整洁 、 高 效 的 环境 来 开发 
应 用 程序 。 新 版 本 支持 更 多 最 新 的 ARM 芯片 ,还 添加 了 一 些 其 他 新 功能 。 
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5.2 飞行 控制 板 控制 系统 软件 总 体 设 计 


5.2.1 总 体 框架 


由 于 飞行 控制 板 控 制 软件 对 于 实时 性 的 要 求 非常 高 ,采用 C 语言 进行 系统 软件 的 设 
计 , 在 主 程序 中 执行 各 类 硬件 和 软件 的 初始 化 函数 ,初始 化 完成 后 进入 while(1) 循 环 。 
除了 数据 通信 和 超声 波 测 距 以 外 ,其 余 飞行 控制 板 所 要 执行 的 功能 均 在 400Hz 的 主 时 间 
中 断 中 依次 进行 ,数据 通信 模块 则 会 触发 端口 中 断 ,超声 波 模 块 则 会 在 数据 采集 到 之 后 
触发 中 断 处 理 数据 并 存 和 变量。 采用 一 个 主 时间 中 断 , 免 去 了 对 于 中 断 优先 级 复杂 的 设 
Ti ,重要 的 处 理 程序 不 会 被 其 他 中 断 所 打 断 ,易于 确认 每 一 次 中 断 是 否 在 下 一 次 中 断 到 
来 前 执行 完毕 ,方便 了 系统 的 计时 ,也 确保 了 飞行 控制 系统 的 稳定 性 。 


5.2.2 初始 化 


1. 电 调 的 初始 化 

在 新 的 电 调 安装 完毕 后 ,需要 根据 电 调 手册 所 提供 的 操作 要 求 , 对 电 调 进行 初始 化 。 
在 程序 中 ,设置 一 个 电 调 初始 化 的 函数 以 供 调用 ,在 主 函 数 执行 完成 芯片 基本 初始 化 和 
PWM 输出 初始 化 之 后 调用 该 函数 , 即 可 完成 对 电 调 的 初始 化 。 在 电 调 初始 化 的 过 程 中 ， 
为 了 防止 因 操作 失误 导致 人 员 受伤 ,通常 不 带 浆 进行 初始 化 ,初始 化 完成 后 , 隐 去 电 调 初 
始 化 函数 。 

电 调 初始 化 就 是 设 定 电 调 的 最 高 转速 和 最 低 转速 ,使 4 个 电 调 实现 对 PWM 波 解析 
的 同步 ,使 四 旋 滩 飞机 能 够 实现 平衡 和 稳定 。 

2. 各 类 软 、 硬 件 的 初始 化 

要 使 一 个 飞行 控制 系统 正常 开始 工作 ,需要 对 软件 和 硬件 作 一 些 初 始 化 。 软 件 方 
面 ,要 初始 化 各 类 参数 (如 PID 参数 、 油 门限 值 等 )、 中 断 及 其 优先 级 等 。 硬 件 方面 ,不 仅 
要 对 芯片 本 身 的 时 钟 PWM $i h, UART 传输 等 进行 初始 化 ,还 要 针对 外 部 对 应 的 硬 
件 ,初始 化 相应 用 于 数据 交换 的 端口 ,对 于 某 些 硬 件 ,还 要 通过 数据 端口 ,初始 化 这 些 硬 
件 内 部 的 参数 ,如 nRF 的 设置 。 其 流程 框图 如 图 5. 2. 1 所 示 。 
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5.2.3 ”中断 处 理 


1. 主 时 间 中 断 

主 时 间 中 断 依次 调用 各 类 函数 以 实现 各 种 功能 。 对 于 不 需要 以 400Hz 的 频率 调用 
的 硬件 或 不 能 以 太 高 频率 使 用 的 硬件 来 说 ,可 以 设置 一 个 计数 器 定时 处 理 。 

例如 ,if(count0%10 二 二 1) 的 语句 ,在 每 若干 个 主 中 断 中 仅 执 行 一 次 ,以 此 来 达到 降 
低频 率 的 效果 。 对 于 不 必要 以 如 此 高 频率 执行 的 而 执行 一 次 又 占用 大 量 时 间 的 多 个 函 
数 ,可 以 用 这 种 方法 使 其 分 别 在 不 同 的 时 钟 周期 中 进行 ,防止 中 断 运行 时 间 溢 出 ,影响 姿 
态 解 算 和 调整 的 稳定 性 。 

主 中 断 流程 框图 如 图 5. 2. 2 所 示 。 

2. 超声 波 中 断 

超声 波 模块 在 主 中 断 触发 超声 波 模块 后 会 发 出 一 东 超 声波 ,根据 超声 波 模块 接收 到 
经 过 地 面 反 射 的 超声 波 ,超声 波 模块 会 向 微 处 理 器 发 送 一 段 脉冲 , 脉 宽 正 比 于 超声 波 发 
送 和 接收 的 时 间 差 , 当 微 处 理 器 接收 到 这 一 脉冲 后 ,进行 一 次 输入 输出 中 断 ,处理 脉冲 波 
数据 获得 高 度 值 ,并 且 存 人 变量 ,等 待 主 中 断 中 的 定 高 控制 函数 进行 调用 。 

3. nRF 中 断 

nRF 在 接收 到 数据 时 ,会 向 微 处 理 器 发 送信 号 ,此 时 微 处 理 器 产生 一 个 端口 中 断 , 判 
断 nRF 正常 连接 并 给 nRF 正常 连接 的 标志 位 置 1, 在 主 中 断 中 接收 nRF 的 数据 的 函数 
中 ,判断 到 nRF 正常 连接 则 会 读 取 nRF 中 缓存 的 数据 ,该 标志 位 也 用 于 自动 锁定 飞机 
CH nRF 没有 连接 时 飞机 自动 锁定 )。 

4. UART mir 

在 设 定 的 UART 数据 端口 接收 到 数据 时 ,会 产生 中 断 ,将 数据 存 人 缓存 区 ,并 置 标 
志 位 , 主 中 断 中 检测 到 标志 位 不 为 0, 则 会 读 取 缓存 区 中 的 数据 。 


5.2.4 飞行 控制 程序 中 的 重要 变量 列表 


飞行 控制 程序 中 的 重要 参数 如 表 5. 2. 1 所 示 。 
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[em [ 
i 


主 时 间 中 断 
(400Hz) 


稳定 和 运动 的 姿态 控制 量 计算 
Y 


PWM 和 输出 1!( 电 机 控制 ) 


LED 


-人 


中 断 优先 级 


初始 参数 (通过 调用 


parma_common.c) 


1 


初始 


化 姿态 解 算 和 调整 


直至 正常 连接 -= 上 Lo 


| 


超声 波 模块 


电 调 初始 化 


5.2.1 初始 化 流程 框图 


是 


发 送 数据 至 nRF 


从 UART 缓 冲 
区 读数 据 ? 


UART 发 送 数据 


5 
je— | 
飞机 解锁 /上 锁 / 模 式 控 和 


i 
PWM 输出 2( 电 机 控制 


i 
系统 时 钟 累 加 


GD 


[5.2.2 主 中 断 流程 框图 
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5.2.1 重要 变量 列表 


变 量 名 变量 含义 
attitudeActual. Roll Sc bes B TRE fl 
attitudeActual. Pitch 实际 俯仰 角 
attitudeActual. Yaw 实际 偏 航 角 
stabDesired. Throttle 油门 控制 量 
stabDesired. Roll 横 深 角 /速度 目标 量 
stabDesired. Pitch 俯仰 角 / 速 度 目 标量 
stabDesired. Yaw 偏 航 角 / 速 度 目 标量 
stabDesired. StabilizationMode[ i] 飞行 控制 模式 
flightStatus. Armed 解锁 /锁定 状态 
actuatorDesired. Throttle 油门 输出 量 
actuatorDesired. Roll 横 滚 方向 输出 量 
actuatorDesired. Pitch 俯仰 方向 输出 量 
actuatorDesired. Yaw 偏 航 方向 输出 量 
sonar_distance[0] 最 近 高 度 值 
nRF_Buf_Out. Data_int[i] /nRF_Buf_Out. Data char[i] nRF 输出 值 
nRF_Buf_In. Data_int[i] /nRF_Buf_In. Data char[i] nRF 输入 值 
Uart_Buf_Out. Data_int[i] /Uart_Buf_Out. Data char[i] UART 输出 值 
Uart_Buf_In. Data_int[i] /Uart_Buf_In. Data_char[i] UART 输入 值 


5.3 四 旋翼 飞行 器 具体 功能 软件 实现 


5.3.1 定 高 飞行 


定 高 系统 采用 超声 波 获取 数据 ,由 遥控 输出 的 油门 量 控制 飞机 距离 地 面 的 高 度 。 飞 
机 实际 的 油门 量 为 遥控 输出 的 油门 量 减 去 由 高 度 进行 PD 计算 所 得 出 的 控制 量 。 这 样 的 
条 件 下 , 当 实 际 油门 量 所 产生 的 升力 刚好 与 飞机 重力 相抵 消 时 ,飞机 达到 平衡 状态 。 而 
每 当 飞 机 高 度 变化 或 遥控 输出 油门 量变 化 ,飞机 都 能 通过 上 升 或 下 降 达 到 新 的 平衡 。 

然而 这 种 方法 各 挡 油 门 所 确定 的 高 度 与 电池 电量 、 飞 机 配 重 等 密切 相关 ,不 能 精确 
定 高 ,因此 后 续 设 计 中 ,更 宜 采取 将 遥控 输出 量 直接 对 应 相应 的 高 度 , 根 据 飞 机 高 度 与 设 
定 高 度 的 差 直接 进行 定 高 控制 , 定 高 系统 将 更 加 精确 和 可 靠 。 

由 于 飞机 的 姿态 始终 在 变化 ,超声 波 获取 的 高 度数 据 并 非 真 实 的 高 度数 据 , 因 此 需 
要 根据 飞机 的 横 滚 角 和 俯仰 角 对 超声 波 数据 进行 修正 。 若 超声 波 模块 处 于 飞机 的 正中 
心 , 那 么 实际 高 度 六 一 Acosacosp(ae\B8 分 别 为 横 滚 角 和 俯仰 角 ) ,如 果 超 声波 模块 不 在 飞机 
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的 正中 央 , 那 么 实际 高 度 设 为 h', 则 h 二 hcosa 士 asina、h 二 hcosB 土 bsinB,a.b 取决 于 超 
声波 模块 与 飞机 中 心 的 距离 , 正 负 取决 于 超声 波 模 块 与 飞机 中 心 的 相对 位 置 。 

在 获取 高 度 后 ,并 不 直接 覆盖 上 次 获取 的 超声 波 数据 ,而 是 将 上 一 次 获取 的 超声 波 
数据 存 人 旧 高 度 值 变量 ,再 将 新 的 数据 存 人 当前 高 度 值 变 量 , 两 次 的 数据 可 以 用 来 计算 
飞机 高 度 方向 的 速度 值 ,用 于 PD 计算 。 定 高 系统 设计 框图 如 图 5. 3. 1 所 示 。 


主 中 断 获取 超声 波 
数据 
i 
获取 上 一 次 高 度 值 计算 高 度 值 
1 i 
获取 修 正 后 高 度 值 ”| 修正 高 度 值 
1 
WR Ma PD 计算 
获取 修正 后 高 度 值 


图 5.3.1 定 高 系统 设计 框图 


5.3.2 定点 悬 停 与 位 移 控制 


定点 悬浮 是 在 姿态 控制 及 高 度 控 制 的 基础 上 实现 的 ,首先 姿态 控制 使 飞机 能 够 平稳 
地 飞行 ,而 高 度 控制 是 飞行 器 保持 在 目标 高 度 上 ,最 后 通过 光 流 传感器 获取 飞行 器 的 位 
移 信 息 ,不 断 地 调节 飞行 器 的 倾斜 角度 ,使 飞行 器 保持 在 固定 一 个 点 附近 ,实现 定点 悬浮 
的 功能 。 定 点 悬浮 流程 框图 如 图 5. 3. 2 所 示 。 

ADNS3080 光 流 软件 编程 如 下 ( 设 定 高 度 为 300mm) : 

if ((High Now» 300) 

&&((ADNS3080 Data Buffer[0] & 0x80) != 0) 


&&(ADNS3080 Data Buffer[3]»- 10) 
&&(att in-» rol«- 45) 


&&(att in-»rol»- -45) 
&&(att in-»pit«- 45) 
&&(att in-»pit»- -45)) 


{ 
float diff roll = att in-»rol - last roll; 
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系统 初始 化 


定时 器 50ms 
时 间 到 否 ? 


采集 光 流 
传感器 数据 


1 


角度 修正 、 
高 度 修正 


p pra 


PID 控 制 


图 5.3.2 定点 悬浮 流程 框图 


float diff pitch = att in-»pit - last pitch; 
change x - x pos - (diff roll * radians to pixels x); 
change y = y pos + (diff pitch * radians to pixels y) ; 
x cm - change x * avg altitude * conv factor; 
y cm = change y * avg altitude * conv factor; 
tot x cm += x cm; 
tot y cm += y cm; 

) 

pos x i += tot x cm; 

pos y i += tot y cm; 

if(pos x i» pos x i max) pos x i - pos x i max; 


if(pos x i« - pos x i max) pos x i = - pos x i max; 
if(pos y i» pos x i max) pos y i = pos x i max; 
if(pos y i< - pos x i max) pos y i = - pos x i max; 


PID POS X.pout - PID POS X.P * tot x cm; 

PID POS X.iout - PID POS X.I * pos x i; 

PID POS X.dout - PID POS X.D * (tot x cm - last tot x cm); 

PID POS X.OUT - PID POS X.pout * PID POS X.iout * PID POS X.dout; 
PID POS Y.pout - PID POS Y.P * tot y cm; 

PID POS Y.iout - PID POS Y.I * pos y i; 

PID POS Y.dout - PID POS Y.D * (tot y cm - last tot y cm); 

PID POS Y.OUT = PID POS Y.pout + PID POS Y.iout + PID POS Y.dout; 


让 条 件 语 句 中 , 先 检测 飞行 器 高 度 是 否 在 300mm DJ E CHigh. Now > 300, 光 流传 感 
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器 由 于 焦距 原因 只 能 测量 距离 30cm 以 上 物体 表面 的 光 流 运动 ) , 光 流 传感器 是 否 有 运动 
(ADNS3080_Data_Buffer[0] & 0x80) ,并 且 飞 行 器 的 roll, pitch 倾斜 角度 不 能 超过 45° 
才 会 进行 光 流 位 移 运 算 。 

证 请 句 中 的 前 四 名 代码 用 于 修正 飞行 器 倾斜 时 给 光 流 传感器 测量 值 带 来 的 误差 , 飞 
行 器 转动 时 光 流 传感器 也 会 测量 到 有 光 流 运动 ,而 在 定点 悬浮 中 需要 的 平移 位 移 ,需要 
将 这 些 倾斜 造成 的 位 移 去 除 掉 , 具 体 如 图 5. 3. 3 所 示 。 


图 5.3.3 光 流传 感 器 角度 修正 示意 图 


飞行 器 roll 角度 方向 转动 造成 的 光 流 位 移 误差 值 计 算 公式 为 


X. — C5.3. 1) 


式 中 ,Xeo 为 X 的 估计 值 ; 9. 为 横 滚 角度 的 改变 值 ; Res 为 传感器 分 辩 率 (像素 ); s 为 比 
例 系 数 ; FF 为 传感器 视野 。 上 面 的 代码 中 diff roll 和 diff pitch 是 飞行 器 的 转动 误差 角 
度 ,radians_to_pixels_x 和 radians to pixels y 分 别 为 两 个 方向 角度 修正 的 系数 ,diff_ 
roll * radians to pixels x 和 diff pitch * radians to pixels y 分 别 代表 飞行 回 在 roll 
和 pitch 方向 转动 时 造成 的 光 流 位 移 误 差 值 ,最 后 要 从 x. pos 和 y pos 中 去 除 这 个 误差 。 

高 度 不 同 , 飞 行 器 移动 相同 的 距离 时 光 流 传感器 测 得 值 有 所 不 同 ,因此 还 要 进行 高 
度 修正 。 原 理 图 如 图 5. 3.4 所 示 。 

高 度 修正 公式 为 


vH F 
Res. s 20X tan zg (5.3.2) 


式 中 ,d 为 移动 的 距离 ; v 为 传感器 输出 值 ; H 为 高 度 , 代 码 中 change. x 和 change. y 对 
应 光 流 传感器 的 位 移 值 ,avg_altitude 是 当前 飞行 器 高 度 单 位 为 cm. conv. factor 为 转换 
系数 ,最 后 得 的 真实 飞行 器 平移 值 单 位 也 为 cm。 

后 面 两 句 代码 将 每 次 光 流 传感器 测量 到 的 位 移 值 累 加 进 总 位 移 值 tot_x_cm 和 


一 
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光 流 在 传感器 的 光 流 在 传感器 的 探测 
探测 范围 内 移动 范围 内 移动 了 一 半 


图 5.3.4 光 流 传感器 高 度 修正 示意 图 


tot y em 中 ,得 到 飞行 器 在 XY 方向 上 与 原点 的 真实 距离 值 。 

接 下 来 的 代码 是 飞行 器 定点 悬 停 的 PID 调节 代码 ,最 后 定点 悬 停 的 输出 量 PID_ 
POS X. OUT 和 PID_POS_Y. OUT 控制 的 是 飞行 器 的 Us (翻滚 输入 控制 量 ) .Us (俯仰 
控制 量 ) ,使 tot_x_cm 和 tot_y_cm 的 值 趋向 于 0, 则 飞行 器 能 够 保持 飞行 在 原点 附近 , 实 
现 定点 悬 停 的 功能 。 

除了 ADNS3080 光 流 传感器 外 ,还 常 采用 PX4Flow 光 流 ,以 下 介绍 一 些 其 独特 
之 处 。 

PX4Flow 采用 MAVLINK 协议 传输 ,传输 的 基本 单位 是 消息 帧 ,一 帧 的 数据 长 度 为 
8B 到 263B 不 等 。 

mavlink 消息 帧 里 最 重要 的 两 个 东西 : 一 个 是 msgid: 另 一 个 是 payload。 前 者 是 
payload 中 内 容 的 编号 ,后 者 则 存放 了 消息 。 消 息 有 许多 种 类 型 ,在 官网 的 主页 中 以 蓝 色 
的 “##” 加 数字 的 方式 来 表示 消息 的 编号 ,如 “#0”( 这 样 的 表示 方法 应 该 是 为 了 方便 在 网 
页 中 查找 相应 编号 消息 的 定义 )。 下 面 将 以 几 个 消息 为 例 , 讲 解 mavlink 消息 。 

具体 分 析 一 个 心跳 包 : 
FE 09 12 01 01 00 (00 00 00 00 02 03 51 03 03) 7B 7A 


FE 为 包 开 头 ,09 为 数据 包 长 度 ,12 为 消息 序号 ,01 为 硬件 系统 序号 ,第 五 位 是 消息 
类 型 序号 ,括号 里 面 是 有 效 数据 载荷 (长 度 为 9) ,最 后 两 位 是 数据 校 验 位 。 通 过 消息 类 型 
序号 可 以 看 到 这 是 0 号 消息 ,0 号 消息 是 心跳 包 消 息 。 重 点 分 析 一 下 这 个 长 度 为 9 的 有 
效 载荷 ,心跳 包 里 面 有 6 个 成 员 变 量 。 
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因此 需要 什么 数据 ,了 解 其 消息 类 型 序号 ,在 执行 一 个 串口 接收 程序 即 可 。 

位 移 控制 也 是 在 姿态 控制 及 高 度 控制 的 基础 上 实现 的 ,位 移 控制 与 定点 悬浮 都 用 到 
了 光 流 传感器 ,位 移 控制 是 在 有 位 移 命令 的 情况 下 才 执 行 的 。 飞 行 器 首先 处 于 定点 悬浮 
的 状态 , 当 用 户 设 定 飞 行 器 向 任意 方向 移动 任意 距离 时 ,飞行 器 进入 位 移 控制 状态 ,通过 
PID 控制 器 不 断 地 调节 飞行 器 倾斜 方向 的 角度 ,使 飞行 器 平稳 ,快速 地 向 目标 地 点 飞行 ， 
同时 用 光 流 传感器 测量 移动 的 距离 , 当 达 到 目标 地 点 后 ,退出 位 移 控制 模式 ,再 次 进入 定 
点 悬浮 模式 。 程 序 流 程 框图 如 图 5. 3. 5 所 示 。 


开始 


系统 初始 化 


到 达 目 的 位 置 ? 


图 5.3.5 位 移 控制 流程 框图 
需要 注意 的 是 ,如 果 只 设 定 一 个 方向 的 位 移 时 ,需要 保持 另 一 个 方向 的 位 移 不 偏离 ， 
即 一 个 方向 做 位 移 PID 调节 , 另 一 个 方向 做 定点 PID 调节 。 位 移 控制 的 调节 量 控制 的 是 
飞行 器 的 U2( 翻 滚 输入 控制 量 )`U3( 俯 仰 控制 量 ) ,使 tot x em 和 tot y em 的 值 趋向 于 
设 定 的 目标 位 移 值 , 飞 行 器 飞 向 目标 位 置 ,实现 位 移 控制 的 功能 。 有 具体 的 PID 调节 部 分 
代码 和 定点 悬浮 的 代码 类 似 , 在 此 不 再 袭 述 。 
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5.3.3 数据 传输 设计 


1. 数据 传输 方式 

1) UART 传输 

UART 传输 为 保证 一 帧 数据 完整 对 于 同步 性 的 要 求 比较 高 ,所 以 在 传输 时 需要 加 入 
同步 位 和 同步 程序 。 接 收 数据 时 ,需要 运行 同步 程序 ,验证 完事 先 设 定好 的 数位 同步 位 之 
后 ,再 从 缓存 区 中 获取 接收 到 的 有 效 数据 ,发 送 数据 时 则 要 在 发 送 的 数据 前 加 上 同步 位 。 

缓存 区 的 使 用 ,降低 UART 传输 对 于 同步 性 的 要 求 , 使 UART 传输 更 加 灵活 ,也 使 
飞行 控制 程序 的 设计 更 加 便捷 。 

在 TI 系列 ARM 芯片 中 ,有 10 余 个 UART 传输 模块 ,根据 微 处 理 器 手册 ,可 以 找 出 
不 同 UART 模块 对 应 的 端口 , 即 可 配置 相应 端口 功能 .中 断 和 波 特 率 等 。 

2) nRF 传输 

nRF 作为 一 块 集成 电路 ,是 作为 微 处 理 器 的 下 位 机 使 用 ,只 需要 通过 微 处 理 器 对 其 
做 相应 的 初始 设 定 , 就 可 以 接收 由 其 他 无 线 模块 发 送 的 数据 并 存储 在 nRF 上 的 缓存 区 
中 。 微 处 理 器 可 以 在 适宜 的 时 间 从 nRF 的 缓存 区 中 获取 数据 。 当 微 处 理 器 想 要 向 外 发 
射 数据 时 ,将 nRF 设 定 成 发 送 模 式 , 就 可 以 将 微 处 理 器 中 的 数据 通过 nRF 发 送出 去 。 

nRF 与 飞行 控制 板 之 间 采 用 的 是 SPI 传输 模式 ,这 种 模式 速度 较 快 ,适应 了 数据 即 
时 交换 的 要 求 。 虽 然 SPI 是 一 种 非常 实用 的 双 工 传输 模式 ,但 是 由 于 nRF 不 支持 双 工 通 
信 , 因 此 程序 中 采用 了 伪 双 工 模式 通信 。 

nRF 的 数据 传输 每 次 传输 8 位 ,而 8 位 的 数据 不 能 传输 更 加 精确 的 飞行 控制 数据 ， 
因此 需要 将 16 位 的 飞行 控制 数据 转换 为 8 位 进行 传输 。 程 序 中 在 一 个 Union 中 定义 了 
char 类 型 变量 和 16 位 int 类 型 变量 ,由 于 两 个 变量 公用 内 存 空间 ,因此 编辑 发 送 的 数据 
时 采用 给 int 类 型 变量 赋值 ,而 发 送 时 将 char 变量 发 送出 去 ,简单 地 实现 了 数据 位 的 拆 
分 ,也 方便 了 发 送 不 同 的 飞行 控制 数据 ,便于 调试 。 

2. 数据 帧 设计 

为 了 数据 能 够 准确 传输 ,在 两 个 设备 进行 通信 时 需要 设计 合理 的 数据 帧 格式 ,包含 
帧 头 、 帧 类 型 位 .所 传 数据 及 校 验 和 。 

帧 头 用 来 识别 一 个 帧 的 开头 ; 帧 类 型 位 用 来 表示 所 传 数据 类 型 ,实现 帧 的 多 功能 复 
用 ; 所 传 数 据 必须 与 帧 类 型 位 所 表示 数据 类 型 一 致 ; 校 验 和 为 校 验 位 之 前 所 有 比特 之 
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和 ,用 于 判断 所 传 数据 是 否 出 错 , 接 收 到 一 个 数据 帧 之 后 ,首先 计算 除 校 验 位 外 所 有 字 节 
之 和 ,并 与 校 验 位 比较 ,如 果 相 同 , 则 该 数据 帧 可 以 使 用 , 若 不 同 , 则 丢弃 该 帧 。 


数据 帧 能 否 正 确 传 输 直接 关系 到 无 人 机 飞行 的 稳定 性 和 安全 性 ,因此 在 数据 帧 传输 


时 需 遵循 “ 宁 缺 考 滥 ”的 原则 ,保证 数据 正确 传输 。 


以 下 为 数据 帧 设计 实例 ,为 上 位 机 和 地 面 站 数据 帧 格式 。 


上 位 机 与 地 面 站 通信 的 一 帧 数据 包含 32B: 


/pt 2B 
Ox9C Ox5F 
帧 数据 类 型 ---------- 1B 
(上 位 机 发 往 地 面 站 时 采用 ) 
0x23 ------- 需要 转发 的 PID 参数 (Pitch/Roll/Yaw) 
0x24 ------- 需要 转发 的 PID 参数 (Height/Pos_X/Pos Y) 
0x25 ------- 询问 PID 参数 
0x91------- X 方向 偏 置 
0x92 ------- Y 方 向 偏 置 
0x93 ------- 偏 航 角 偏 置 
(地 面 站 发 往 上 位 机 时 采用 ) 
Oxlc------- 遥控 器 数据 
0x02 ------- 飞行 器 姿态 数据 
0x04 ------- 飞行 器 上 存储 的 PID 数据 (Pitch/Roll/Yaw) 
0x05 ------- 飞行 器 上 存储 的 PID 数据 (Height/Pos_X/Pos_Y) 
ES -—————-——---—- 28B 
PR---—-------—-- 1B 


5.3.4 控制 系统 设计 


控制 系统 主要 由 3 个 部 分 组 成 ,接收 遥控 器 或 设 定 的 数据 .通过 PID 运算 计算 出 合 


适 的 输出 量 、 将 输出 量 通过 PWM 波 输出 ,每 个 部 分 缺 一 不 可 。 


接收 的 遥控 器 的 数据 包括 飞机 的 模式 数据 和 3 个 姿态 角 的 控制 量 ,同时 要 进行 解 


锁 / 锁 定 的 处 理 。 若 飞机 处 于 锁定 状态 (DISARMED) ,而 遥控 器 发 出 了 解锁 指令 , 则 飞机 
要 经 过 200 个 主 时 钟 周期 完成 解锁 。 若 飞机 处 于 解锁 状态 (ARMED) 而 遥控 器 发 出 锁定 


令 , 则 在 190 个 主 时 钟 周期 之 后 完成 锁定 。 这 200/190 个 周期 给 飞机 赋予 的 状态 为 正 


在 解锁 /锁定 (ARMING) ,在 这 个 状态 下 ,飞机 根据 遥控 的 指令 继续 解锁 或 锁定 。 若 遥控 
指令 与 飞机 状态 相同 , 则 不 进行 解锁 和 锁定 操作 。 


飞行 控制 板 的 输出 量 则 是 经 由 openpilot 库 中 的 stabalization. h 函数 ,根据 程序 设 定 
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好 的 模式 Crate attitude 或 其 他 ) 进 行 一 层 或 两 层 PID 运算 ,获取 相应 的 初始 输出 量 。 

经 过 稳定 性 计算 ,计算 得 到 油门 量 二 俯仰 控制 量 p BRE a r 和 自 旋 控制 量 y， 
根据 以 下 公式 计算 出 4 个 电机 的 输出 量 : 

ml-ttr-pty; 

m2-t-r-p-y; 

m3-t-rtpty; 

md-ttrtp-y; 

计算 所 得 的 4 个 电机 的 输出 量 , 则 要 通过 微 处 理 器 的 PWM 波 输出 功能 输出 到 电 
调 , 但 在 此 之 前 ,还 需要 对 输出 量 进行 检验 , 若 超出 实现 设 定好 的 输出 量 的 上 下 限 , 则 按 
照 上 下 限 输出 ,这 也 是 出 于 对 飞机 和 人 的 安全 以 及 飞机 耐用 性 的 考虑 。 

PWM 输出 使 用 板 载 的 PWM 端口 输出 PWM 波 ,Tm4C123G 芯片 上 有 大 量 PWM 
输出 通道 ,使 用 其 中 4 个 PWM 输出 通道 , 设 定 周期 为 2. 5ms, 脉 宽 为 0 一 2ms, 根 据 无 人 
机 飞行 状态 和 控制 指令 实时 改变 脉 宽 以 控制 电机 转速 ,实现 无 人 机 的 平稳 飞行 和 设 定 飞 
行动 作 。 

在 控制 系统 的 设计 中 ,还 需要 根据 MPU6050 的 安放 位 置 设立 正确 的 坐标 系 , 严 格 按 
照 捷 联 惯 性 制导 的 规则 ,才能 让 飞机 获取 正确 的 角度 值 ,做 出 正确 的 俯仰 、 横 滚 和 自 旋 动 
作 维 持 飞 机 的 稳定 或 者 实现 各 种 自 定义 动作 ,如 图 5. 3.6 所 示 。 


获取 遥控 获取 姿态 
控制 量 解 算数 据 


解锁 /上 锁 状 态 
让 ”处 理 和 控制 量 


设 定 


解锁 /锁定 飞 控 模式 控制 量 __| 稳 定 和 运动 姿态 控 
控制 量 设置 制 量 融 合计 算 


i 
角度 控制 量 融 全 为 电 


机 控制 量 


| 


PWM 波 调制 输出 


图 5.3.6 控制 系统 流程 框图 
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5.4 地面 站 软件 设计 


在 飞行 器 研发 试验 过 程 中 ,需要 实时 监控 各 种 数据 值 的 变化 。 地 面 控 制 板 软 件 相 当 
于 一 个 通信 的 中 转 站 ,同时 与 飞行 控制 板 、 遥 控 器 和 PC 上 位 机 软件 通信 ,将 遥控 器 命令 
及 上 位 机 的 命令 数据 发 送 给 飞行 控制 板 , 同 时 又 将 飞行 控制 板 反馈 回来 的 实时 飞行 数据 
显示 在 OLED 屏幕 上 或 者 转发 给 上 位 机 软件 动态 显示 ,要 保证 这 些 通信 任务 相互 之 间 不 会 
发 生 冲 突 , 也 需要 同 飞 行 控制 板 一 样 有 严格 的 时 序 控制 ,具体 的 软件 框图 如 图 5. 4. 1 所 示 。 


m "REJ BOITA 
p | emen "| ats "| 反馈 信息 
Drs 
数据 
MCU 执 行 单元 L—e| 定时 器 -| 9mszM | -| mna 上 | SERT 
MORET 
状态 数据 
L_ e| iooms 定 时 un 


图 5.4.1 地 面 控制 板 软件 框图 


5.4.1 地 面 站 系统 组 成 与 图 形 化 的 界面 操作 设计 


地 面 站 系统 LCD( 如 图 5.4.2 所 示 ) 上 显示 的 内 容 以 下 。 

显示 遥控 数据 ,通过 引 脚 中 断 和 时 钟 计数 , 测 出 遥控 器 传 过 来 的 数据 。 数 据 格式 为 : 
第 一 个 数据 是 帧 关 , 检 测 到 帧 头 后 ,再 把 后 面相 应 的 数据 保存 在 相应 的 数组 中 。 没 有 检测 
到 则 不 保存 。 显 示 的 数据 分 别 为 高 度 油门 值 . 横 滚 油 门 值 . 俯 仰 油门 值 和 偏 航 油门 值 。 

© 显示 四 旋翼 飞机 传 回来 的 数据 。 通 过 SPI 读 取 nRF 的 数据 包 , 数 据 分 别 为 俯仰 角 
(pitch) 、 横 滚 角 (rolD 、 偏 航 角 (yaw) 、 飞 行 高 度 (height) 飞机 当前 坐标 C(z,y) 即 光 流 值 。 

© 显示 地 面 站 和 四 旋 愤 飞机 的 解锁 状态 ,分 别 为 飞机 是 否 解 锁 `.nRF 与 地 面 站 的 通 
信和 是 否 正 常 和 遥控 器 与 地 面 站 连接 是 否 正常 。 

CD 波形 显示 模块 。 将 最 近 的 飞行 状态 绘制 成 曲线 显示 。 选 择 分 别 有 高 度 、 横 滚 、 仿 
仰 和 偏 航 4 种 ,如 图 5.4.3 所 示 。 


3 
Ol 
id 


旋翼 飞行 器 软件 系统 设计 | 113 


nRF 模 块 


高 度 以 及 
姿 志 数据 波形 


图 5.4.3 高 度 波形 ( 左 ) 和 姿态 角 波 形 ( 右 ,以 Roll 角 为 例 ) 显 示 


114 <l 


9 旋翼 飞行 器 设计 与 实现 


5.4.2 与 四 旋翼 飞行 器 的 通信 协议 


为 了 实现 飞行 控制 板 、 地 面 控制 板 以 及 PC 上 位 机 三 者 之 间 的 稳定 、 可 靠 , 快 速 地 进 
行 通信 ,地 面 站 与 上 位 机 使 用 了 特定 的 数据 帧 格式 进行 通信 ,地 面 站 与 飞机 是 通过 nRF 
进行 无 线 通信 的 。 地 面 站 与 遥控 器 也 是 通过 特定 的 数据 帧 格式 进行 通信 。 

地 面 站 通过 识别 帧 头 来 判断 数据 的 类 型 ,从 而 做 出 相应 的 反应 ,并 且 将 未 尾 等 于 所 
有 位 的 累加 和 作为 校 验 位 ,来 确保 数据 传输 的 准确 性 。 数 据 帧 结构 如 表 5. 4. 1 所 示 , 地 
面 站 与 上 位 机 通信 协议 如 表 5. 4. 2 和 表 5. 4. 3 所 示 , 帧 数据 共 32B。 


表 5.4.1 数据 帧 格式 表 


数据 帧 Wik 数据 类 型 数据 内 容 校 验 位 说 明 
长 度 /B 2 1 28 1 一 帧 数据 长 度 共 32B 


表 5.4.2 地 面 站 与 上 位 机 通信 协议 表 工 


地 面 站 接收 上 位 机 数据 
数据 类 型 意 X 
roll 方向 平衡 PID 参数 值 P 值 
roll 方向 平衡 PID 参数 值 [ 值 
roll 方向 平衡 PID 参数 值 D 值 
pitch 方向 平衡 PID 参数 值 P 值 
0x23 pitch 方向 平衡 PID 参数 值 1 值 
pitch 方向 平衡 PID 参数 值 D 值 
yaw 方向 平衡 PID 参数 值 P 值 
yaw 方向 平衡 PID 参数 值 1 值 
yaw 方向 平衡 PID 参数 值 D ffi 
高 度 PID 参数 值 ffi 
高 度 PID 参数 值 1 值 
高 度 PID 参数 值 D 值 
X 方向 悬 停 PID 参数 值 P 值 
0x24 X 方 向 悬 停 PID 参数 值 1 值 
X 方 向 悬 停 PID 参数 值 D f 


工 方 向 悬 停 PID 参数 值 P 值 


工 方向 悬 停 PID 参数 值 1 值 


工 方向 悬 停 PID 参数 值 D 值 
0x25 nRF 发 送 数据 包 
0x90 测试 飞行 (高 度 BR Ed 
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续 表 
地 面 站 接收 上 位 机 数据 
数据 类 型 & X 
0x91 向 前 后 飞行 控制 量 
0x92 向 左右 飞行 控制 量 
0x93 偏 航 飞行 控制 量 


表 5.4.3 ”地面 站 与 上 位 机 通信 协议 表 工 


地 面 站 发 送 数据 至 上 位 机 


帧 头 数据 类 型 € x 
发 送 飞 机 的 pitch ff 

发 送 飞 机 的 roll 值 

Oe 发 送 飞 机 的 yaw 值 

发 送 飞 机 的 高 度 值 


发 送 飞机 的 光 流 数据 X 方向 值 
发 送 飞 机 的 光 流 数据 Y 方向 值 
Jii fe de BUR (E 

发 送 遥 控 器 俯仰 值 

发 送 遥 控 器 油门 值 

发 送 遥 控 器 偏 航 值 

roll 方向 平衡 PID 参数 值 P fii 
roll 方向 平衡 PID 参数 值 1 值 
roll 方向 平衡 PID 参数 值 D 值 
Ox9c pitch 方向 平衡 PID 参数 值 P 值 
Ox5f 0x04 pitch 方向 平衡 PID 参数 值 I 值 
pitch 方向 平衡 PID 参数 值 D 值 
yaw 方向 平衡 PID 参数 值 P 值 
yaw 方向 平衡 PID 参数 值 fft 
yaw 方向 平衡 PID 参数 值 D fii 
高 度 PID 参数 值 P 值 

高 度 PID 参数 值 1 值 

高 度 PID 参数 值 D fii 

X 方向 悬 停 PID 参数 值 P 值 
0x05 X 方向 悬 停 PID 参数 值 I 值 
和 方向 悬 停 PID 参数 值 fft 
Y 方向 悬 停 PID 参数 值 P 值 
立方 向 悬 停 PID 参数 值 1 值 
立方 向 悬 停 PID 参数 值 D 值 


Oxlc 
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表 中 pitch 指 的 是 俯仰 ,roll 指 的 是 横 滚 ,yaw 指 的 是 偏 航 。PID 指 的 是 比例 积分 微 
分 调节 。 


5.4.3 遥控 器 PPM 信号 捕获 


1. 遥控 器 信号 收发 原理 

无 线 静 控 就 是 利用 高 频 无 线 电波 实现 对 模型 的 控制 ,原理 如 图 5. 4.4 所 示 。 如 天 地 
飞 的 6 通道 2. 4GHz 遥控 器 ,具有 自动 跳 频 抗 干扰 能 力 , 从 理论 上 讲 可 以 让 上 百人 在 同 
一 场地 同时 遥控 自己 的 模型 而 不 会 相互 干扰 。 而 且 在 遥控 距离 方面 也 颇具 优势 ， 
2. 4GHz 遥控 系统 的 功率 仅仅 在 100mW 以 下 ,而 它 的 遥控 距离 可 以 达到 1km 以 上 。 


操作 手柄 NW 


PPM 编 码 —9| PPM | "5i = X 


DU] NV 


ME. A dux 


: PPM 解 码 = PPM |- 


(b) 接收 机 
图 5.4.4 禹 控 器 发 射 机 、 接 收 机 原理 


每 个 通道 信号 脉 宽 为 0 一 2ms, 变 化 范围 为 1 一 2ms。1 Wi PPM 信号 长 度 为 20ms, 理 
论 上 最 多 可 以 有 10 个 通道 ,但 是 同步 脉冲 也 需要 时 间 ,模型 遥控 器 最 多 9 个 通道 。 

2. 读 取 和 解码 遥控 器 信号 

由 于 PPM 信号 通过 脉冲 相位 表示 数据 ,因此 地 面 站 读 取 PPM 信号 中 的 数据 主要 通 
过 定时 器 来 实现 。 

遥控 器 发 出 的 PPM 同步 信号 为 高 电 平 ,脉冲 为 负 脉 冲 , 因 此 ,当地 面 站 接收 到 遥控 
器 PPM 信号 时 ,在 上 升 沿 触发 开启 定时 器 ,在 下 降 沿 停止 定时 器 并 和 触发 定时 器 中 断 , 读 
出 定时 器 CCR ,CCR 的 计数 值 , 即 反 映 脉冲 与 脉冲 之 间 的 相位 差 。 同 步 信号 的 高 电 平 保 
持 时 间 较 长 ,因此 CCR 数值 较 大 ,可 以 以 此 为 依据 检测 同步 信号 并 开始 接收 数据 。 同 步 
信号 之 后 获取 的 新 的 一 组 8 个 CCR 值 即 为 PPM 信号 所 传 数据 ,依次 存储 8 个 CCR fü. 
即 可 解析 遥控 器 信号 。 
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部 分 实现 代码 如 下 : 


void TIM4 IRQHandler(void) 
{ 
if(TIM4 -> SR & TIM IT CC1) //if(TIM GetITStatus(TIM2, TIM IT CC1) -- SET) 
{ 
count = TIM4 -> CCR1; // 读 ccr, 清 cclif 标志 
TIM4->CNT = 0; // 清 cnt 
) 
ppndecoder f(); 
f 


void ppndecoder f() 


{ 
if (5000 < count&&count < 20000) 
( 
ppmChMax = sync; 
sync - 0; 
ppnLoseSig - 0; 
} 
else if(200 < count&&count < 2000&&sync < PPMCH MAX) 
synctt; 
else 
ppnLoseSig - 1; 
if(ppnLoseSig == 0) 
ppnData[ sync] = count; 


5.5 上 位 机 软件 设计 


上 位 机 软件 是 使 用 C# 语 言 开发 的 ,负责 向 用 户 显示 飞行 器 的 实时 飞行 数据 ,并 提供 
给 用 户 以 图 形 化 的 界面 操作 方式 向 飞行 器 发 送 命令 。 为 了 能 够 快速 地 通过 串口 接收 数 
据 , 并 通过 各 种 UI 控件 显示 数据 ,除了 主线 程 外 ,上 位 机 软件 中 还 建立 了 两 个 线程 ,分 别 
用 于 接收 数据 和 显示 数据 。 软 件 框图 如 图 5. 5. 1 所 示 。 


5.5.1 软件 功能 


软件 集成 的 功能 包括 基本 收发 功能 、 飞 行 控制 参数 设置 功能 、 光 流传 感 器 参数 设置 
功能 、RC 还 控 器 设置 功能 .飞行 控制 状态 显示 功能 以 及 波形 显示 功能 。 下 面 介 绍 几 个 主 
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sm 
主线 各 fen 绘制 UI 控件 

上 位 机 软件 | might 
| LM mi 


5.5.1 上 位 机 软件 框图 


要 功能 的 特点 及 使 用 。 

1. 基本 收发 功能 

如 图 5. 5.2 所 示 , 在 基本 功能 里 左 侧 的 大 文本 框 可 以 输入 待 发 送 的 字符 串 或 十 六 进 
制 数 据 , 单 击 “ 发 送 " 按 钮 可 以 直接 发 送出 去 , 右 侧 的 大 文本 框 可 以 显示 接收 到 的 字符 串 
或 十 六 进 制 数据 ,最 右边 可 以 发 送 自 定义 的 32B 数据 帧 , 帧 头 、 数 据 格式 以 及 数据 内 容 都 
可 以 自己 定义 , 单 击发 送 ”按钮 ,数据 帧 软件 会 自动 加 上 和 校 验 后 发 送出 去 


l 


5.5.2 基本 收发 功能 截图 


第 5 章 ”四 旋翼 飞行 器 软件 系统 设计 | 119 


2. 飞行 控制 参数 设置 功能 


如 图 5. 5. 3 所 示 ,在 这 里 可 以 设置 7 个 PID 控制 器 的 PI.D 参数 ,更 改 目标 高 度 , 修 
改 加 速度 计 和 陀螺 仪 的 偏 置 参数 。 


Bi] Quadrotor Master. - H X 


[85.5.3 飞行 控制 参数 设置 功能 截图 


左边 部 分 为 PID 参数 收发 ,主要 用 于 快速 设置 飞行 器 的 各 种 PID 参数 。 这 部 分 功能 
是 将 设置 好 的 参数 写 到 串口 处 , 单 击 * 设 定 ” 参 数 按钮 之 后 ,发 送 写 数据 命令 ,能 让 读 取 到 
数据 的 地 面 站 将 接收 到 的 数据 写 入 飞行 控制 板 的 EEPROM 中 ,等 飞行 器 断 电 重 启 之 后 ， 
就 能 获得 设 定 的 参数 了 。 

右上 部 分 为 飞行 控制 部 分 ,这 部 分 是 基于 飞行 器 悬 停 位 置 的 操作 ,具体 作用 是 改变 
飞行 器 悬 停 点 ,那么 飞行 器 就 可 以 往 相 关 方向 飞行 。 

布下 部 分 为 飞行 测试 模块 ,这 部 分 是 选择 将 要 测试 的 radio button, 然 后 单 击 “ 开 始 
测试 "按钮 之 后 ,飞行 器 会 自动 进行 设 定 好 的 轨迹 飞行 ,飞行 10s 之 后 ,飞行 器 会 飞 回 原 
来 状态 ,此 时 会 弹出 对 话 框 ,提示 飞行 器 的 测试 是 否 通过 以 及 是 否 符合 标准 。 如 果 没 能 
通过 ,那么 会 给 出 建议 的 PID 修改 方案 。 

3. 飞行 控制 状态 显示 功能 

如 图 5.5.4 所 示 . 在 这 个 功能 里 用 到 了 一 个 使 用 OpenGL 开源 图 形 库 绘制 的 动态 
3D 模型 ,可 以 形象 地 显示 出 飞行 器 的 动态 姿态 ,动态 模型 的 右边 ,Attitude Sensor 组 合 
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框 中 显示 的 是 飞行 器 的 传感器 数据 及 姿态 数据 ,“ 和 遥控 器 ”一 栏 显示 当前 遥控 器 的 遥控 
值 ,Motor 一 栏 以 进度 条 的 方式 显示 飞行 器 4 个 电机 的 PWM 值 的 大 小 ,Other 组 合 框 显 
示 了 飞行 器 高 度 、 位 移 信 息 、 解 锁 状 态 和 飞行 时 间 的 统计 。 


= 生 数 传递 = = 飞 控 状态 = -meBM- 


图 5.5.4 飞行 控制 状态 图 

进入 飞行 控制 状态 选项 卡 之 后 ,能 看 到 左 侧 的 飞行 器 模型 和 仪表 盘 以 及 右 侧 的 高 度 
进度 条 。 右 边 有 遥控 器 的 值 和 下 面 的 status chart 的 显示 框 。 当 飞行 器 飞 起 来 的 时 候 ， 
左 侧 的 框图 里 面 的 飞行 器 会 实时 地 根据 真实 飞行 器 的 参数 进行 同步 3D 姿态 变化 ,上 面 
的 仪表 盘 也 会 指向 相应 的 值 。 在 左右 两 侧 的 仪表 盘 加 上 了 红色 区 域 ,目的 是 提醒 飞行 器 
的 危险 状态 。 

在 右 下 部 分 是 飞行 器 数据 参数 波形 显示 部 分 ,在 这 个 部 分 中 可 以 选择 相应 的 数据 ， 
那么 在 飞行 器 起 飞 之 后 ,数据 就 会 依次 以 点 连接 的 方式 ,在 绿色 的 框图 上 形成 波形 ,这 个 
时 候 可 以 选择 保存 位 置 和 采样 间隔 ,然后 单 击 “ 开 始 保 存 数据 "按钮 。 那 么 数据 就 会 实时 
地 保存 在 Excel 表格 里 面 ,方便 以 后 的 查看 和 使 用 。 

4. 波形 显示 功能 

图 5. 5. 5 所 示 功 能 能 够 将 飞行 器 的 高 度数 据 以 波形 的 方式 动态 显示 出 来 ,以 便 观察 
高 度 变 化 的 规律 。 


Bl Quadrotor Maste 


= 和 本 收发 = -emem- -vcwn- AVEN- 
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图 5.5.5 波形 显示 功能 截图 


5.5.2 软件 实现 


上 位 机 程序 流程 框图 如 图 5. 5.6 所 示 。 


1. 通信 模块 
上 位 机 软件 由 4 个 选项 卡 组 成 ,第 一 模块 为 通信 测试 模块 ,主要 用 于 串口 通信 测试 ， 
流程 框图 如 图 5. 5. 7 所 示 。 
通过 下 拉 菜 单 设置 串口 端口 号 和 波 特 率 ,串口 在 打开 时 ,首先 执行 判断 操作 ,如 果 串 


图 


5.5.6 上 位 机 程序 流程 框图 


程序 
1 ! ! | 
界面 刷白 数据 处 理 | 。 | 数据 存储 数据 谈 取 
1 1 1 1 
ora c | | MEM MET 


g 
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amu [I 


AHRS 


单 击 基本 收发 T 


| | 


未 选择 串口 或 


,地面 站 进行 基本 通信 | | 可 按 收 识别 地 面 站 发 送 来 
祁 地 而 站 进行 基本 通信 | | “的 有 效 数据 由 并 处 理 


图 5.5.7 通信 测试 流程 框图 


口 或 者 波 特 率 没有 设置 ,那么 会 出 现 错误 提示 框 , 提 醒 设置 串口 和 波 特 率 。 在 打开 串口 
之 后 ,可 以 选择 数据 收发 模式 。 模 式 由 枚 举 变量 Mode Statue 设 定 : 
enum Mode Statue 
{ 
None, 
Normal Mode, 
Frame Mode, 
Wave Mode, 
Pic Mode, 
}; 
常用 的 为 基本 收发 模式 和 数据 帧 模式 。 
如 果 选 择 基 本 收发 模式 ,就 可 以 使 用 此 界面 上 的 数据 发 送 和 清空 按钮 ,通过 串口 发 
送 数据 给 地 面 站 ,地面 站 收 到 后 返回 发 送 的 数据 这 一 过 程 来 判断 数据 接收 是 否 正常 。 
选择 数据 帧 模式 之 后 ,就 是 将 带 帧 头 的 数据 通过 串口 发 送 给 地 面 站 ,地 面 站 通过 识 
别 帧 头 来 判断 数据 的 类 型 ,从 而 做 出 反应 ,并 且 将 末尾 等 于 所 有 位 的 累加 和 作为 校 验 位 ， 
来 确保 数据 传输 的 准确 性 。 
一 般 情况 下 ,选择 数据 帧 收发 模式 ,然后 进入 参数 传递 的 界面 ,流程 框图 如 图 5. 5. 8 
所 示 。 
下 面 介绍 这 个 操作 界面 上 各 个 控件 的 作用 。 
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| 1 
PID 无 线 收发 飞行 器 控制 
未 选择 测 
1 ! 试 类 型 
获取 PID 设置 PID ! 
发 送 飞行 参数 
! ] 
发 送 数据 类 型 为 | | 发 送 数据 类 型 为 XC IRA 
0x24 数 据 命令 | | 0x23 数 据 命令 2 VITBS 控制 飞行 器 向 前 、 后 、 左 、 右 
4 个 方向 和 两 个 偏 航 方向 飞行 
! 1 采集 飞行 数据 
更 新 显示 出 此 时 | TDI 
飞行 器 的 PID 值 || 值 设置 到 飞行 器 分 析 飞行 数据 
的 EFPROM 里 面 T SITROGR 
i 
弹 窗 绘图 给 出 
PID 修 改建 议 


图 5.5.8 参数 传递 流程 框图 


1) xtBox 控件 

显示 此 时 的 PID 数据 。 

2) Button 控件 

CD 获取 参数 button; 串口 写 命令 给 地 面 站 ,让 地 面 站 读 取 飞 行 器 此 时 的 PID 数据 并 
发 回 到 上 位 机 。 

© 设 定 参 数 button: 将 上 述 所 有 设 定好 的 参数 发 送 到 串口 ,地 面 站 接收 到 数据 和 命 
令 时 ,将 PID 数据 写 入 飞行 器 的 EEPROM 里 面 。 

© 方向 控制 button; 单 击 之 后 设 定 飞行 器 的 定点 位 置 ,实现 飞行 器 的 飞行 ,同时 可 
以 调节 飞行 器 的 偏 航 。 

@ 开始 测试 button: 单 击 之 后 识别 radio button 的 checked fii. M mi itf; K fT 
测试 。 

Button 发 送 函 数 如 下 : 


private void button7_Click(object sender, EventArgs e) 
í 
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if (serialPortl.IsOpen == false) 
{ 
MessageBox. Show(" 请 先 打开 串口 "，"ERROR" ) ; 
return; 
} 
updown ctrl = updown ctrl + 20; 
label59.Text - updown ctrl.ToString(); 
try 
{ 
byte check sum = 0; 
uint addr - 0; 
Array.Clear(TxBuffer Frame, 0, 32); 


TxBuffer Frame[addr**] = Ox9c; 
TxBuffer Frame[addr++] Ox5f; 
TxBuffer Frame[addr++] 0x91; 


TxBuffer Frame[addr++] = (byte)(updown ctrl % 256); 
TxBuffer Frame[addr++] (byte) (updown ctrl»» 8); 
for (int i = 0; i«31; i+) 
{ 

check sum = (byte)(check sum + TxBuffer Frame[i]); 
} 
TxBuffer Frame[31] = check sum; 
serialPortl.Write(TxBuffer Frame, 0, 32); 


} 
catch (Exception err) 


i MessageBox. Show ("发 送 失 败 : " + err. Message, " 串口 发 送 提示 "， 

MessageBoxButtons. OK, MessageBoxIcon. Error); 

) } 

所 有 的 按键 发 送 指 令 函 数 都 是 以 上 述 函 数 为 模型 的 ,所 以 仅 取 一 例 作 为 代表 。 所 有 
的 发 送 函 数 的 第 一 步 都 是 判断 串口 是 否 连 上 ,因为 这 是 发 送 数据 的 基本 要 求 ,只 有 串口 
检测 是 正确 的 , 连 上 后 才 会 执行 下 面 的 步骤 ,不 然 就 提示 “请 先 打开 串口 "然后 返回 。 在 
串口 正确 连接 的 情况 下 ,程序 会 执行 try O 函数 ,这 个 函数 是 保证 在 数据 写 串口 的 过 程 
中 ,有 任何 地 方 出 现 错误 都 能 及 时 抛 出 错误 ,被 catch O 函数 接收 后 ,正确 退出 ,这 样 有 利 
于 提高 程序 的 鲁 棱 性 。 程 序 先 将 TxBuffer 数组 赋值 上 帧 头 , 然 后 将 需要 赋值 的 变量 赋 
值 到 TxBuffer 数组 上 。 这 里 需要 注意 的 是 ,TxBuffer 数组 是 char 型 数组 ,所 以 赋值 的 时 
候 如 果 是 Int 类 型 或 其 他 类 型 ,要 注意 转换 。 赋 值 完成 之 后 ,TxBuffer 的 末尾 会 将 数组 
的 累加 值 存 起 来 (不 用 担心 溢出 问题 ,因为 作为 校 验 位 ,如 果 这 边 是 一 个 有 溢出 丢失 的 
值 ,那个 在 检测 的 地 方 也 会 是 累加 有 溢出 丢失 的 值 ,所 以 还 是 可 以 用 于 判断 数据 传输 的 
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正确 性 ) ,用 于 校 验 使 用 。 

2. 飞行 测试 模块 

飞行 测试 模块 的 控制 按钮 有 3 个 radio button 和 一 个 测试 按钮 。 当 选择 好 要 进行 测 
试 的 模式 后 , 单 击 “ 测 试 ”按钮 。 这 时 测试 按钮 会 给 飞行 器 发 送 一 个 测试 飞行 指令 ,飞行 
器 会 按照 事先 写 好 的 飞行 动作 进行 飞行 。 飞 行 器 在 进行 这 个 动作 飞行 过 程 中 ,上 位 机 实 
时 地 读 取 它 的 飞行 参数 值 ,并 存储 到 Excel 表格 中 。 

DataSet QuadrotorData = new DataSet(); 

QuadrotorData = LoadDataFromExcel("QuadrotorData. xlsx"); 

buttonl8.Invoke(new EventHandler(delegate ( button18. Text = "正在 采集 数据 "; ))); 

for (inti = 0; i< 200; i++) 


( 
Switch (test flag) 


í 


case 1: b[i] = height += 1; QuadrotorData. Tables["Sheet1"].Rows[i]["F" + (1)] = 
height; break; 

case 2: b[i] = x pos; QuadrotorData. Tables["Sheet1"].Rows[i]["F" + (1)] = x pos; 
break; 

case 3: b[i] = y pos; QuadrotorData. Tables["Sheet1"].Rows[i]["F" + (1)] = y pos; 
break; 


MR Sleep(50); 

) 

按 以 上 方式 存储 好 之 后 ,将 存储 在 数组 b 里 面 的 200 个 数据 进行 分 析 , 首 先 取 出 最 
大 值 和 最 小 值 ,计算 最 大 峰 峰 值 。 然 后 将 存储 在 数组 max 和 _min 里 面 的 波形 峰值 进行 
比较 和 判断 ,算出 相 邻 波峰 与 波 谷 之 间 的 差 值 ,判断 差 值 走向 ,并 且 算出 波形 个 数 ,最 后 
建立 以 下 4 个 模型 。 

(D 正常 平稳 飞行 控制 (如 图 5. 5. 9 所 示 ) , 若 觉得 平稳 速度 较 慢 ,PID 调节 可 以 略微 
WAK D, 但 如 果 D 超过 一 个 临界 值 , 则 飞行 器 会 出 现 图 5. 5. 10 至 图 5. 5. 12 所 示 的 一 种 
情形 , 则 需要 再 调节 回来 ,找到 一 个 最 大 D, 则 是 最 合适 的 D。 如 果 平 稳 速度 较 快 ,也 可 不 
用 再 调节 。 

@ 此 时 系统 渐变 到 不 稳定 (如 图 5. 5. 10 所 示 ) ,说 明 Kp 参数 过 大 ,或 者 Ko 参数 过 
小 或 者 过 大 。 建 议 先 调节 Ko 参数 , 若 出 现 系统 稳定 性 高 于 本 次 , 则 继续 调 往 同 一 方向 
Ky 参数 ,车 无 明显 效果 , 则 向 反方 向 调整 参数 。 
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图 5.5.9 正常 平稳 飞行 控制 图 5.5. 10 系统 渐变 到 不 稳定 


@ 此 时 系统 直接 处 于 不 稳定 状态 (如 图 5. 5. 11 所 示 ) ,说 明 Kp 参数 过 大 ,导致 过 

该 减 小 Ke 参数 ,再 进行 观察 。 

@ 系统 开始 高 频率 震荡 (如 图 5. 5. 12 所 示 ) ,说 明 Ko 参数 过 大 ,虽然 Ko 参数 具有 
预测 误差 变化 趋势 , 减 小 超 调 量 ,克服 振荡 ,使 系统 的 稳定 性 提高 ,还 能 加 快 系统 的 动态 
响应 速度 , 减 小 调整 时 间 的 作用 ,但 是 过 大 会 导致 系统 高 频率 振荡 ,此 时 调 小 Ko 再 次 
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5.5.11 系统 直接 处 于 不 稳定 状态 图 5.5.12 系统 开始 高 频率 振荡 


建立 4 个 模型 之 后 ,能 够 通过 数据 和 波形 的 拟 合 ,大 体 判 断 出 PID 参数 调节 的 方向 ， 
给 调试 者 一 个 提示 。 但 过 于 精细 的 调节 还 是 需要 实际 的 观察 来 定 的 。 所 以 在 上 位 机 制 
作 的 时 候 , 当 数据 处 理 完成 存储 好 了 之 后 ,会 弹出 一 个 窗口 ,这 个 窗口 会 把 处 理 的 数据 模 
型 拟 合 之 后 给 出 调节 建议 ,同时 把 处 理 的 数据 原封 不 动 地 绘制 成 波形 图 ,有 利于 调试 者 
直观 地 看 到 飞行 器 测试 飞行 的 数据 。 下 面 给 出 两 幅 实际 采样 图 片 ,该 图 已 经 是 较为 成 熟 
的 PID 参数 (如 图 5.5.13 所 示 ) 。 

3. 飞行 控制 状态 模块 

这 个 模块 主要 用 于 显示 飞行 器 数据 和 状态 .遥控 器 的 遥控 数据 等 作用 ,程序 流程 杠 
图 如 图 5. 5. 14 所 示 。 下 面 先 介绍 控件 。 

1) pictureBox 控件 

用 于 绘制 仪表 盘 , 并 根据 数据 的 刷新 ,刷新 指针 ,实时 指向 对 应 的 飞机 参量 值 ,并 在 
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图 5.5.13 PID 参数 修改 前 后 的 实际 采样 图 片 


参数 传递 


| } | 
模型 绘制 参数 更 新 数据 保存 波形 显示 
i 1 i i 
OpenGL 绘 制 获取 数据 帧 选择 保存 类 型 选择 显示 类 型 
| i i | 
分 析 帧 头 判断 设 定 保存 路 径 
Dott 数据 类 型 和 采样 频率 实时 更 新 波形 
更 新 lable 数 据 单 击 “ 开 始 保存 ~ 
按钮 吗 ? 


开始 保存 数据 


图 5.5.14 飞行 控制 状态 模块 流程 框图 


指针 下 面 显示 对 应 值 。 
2) OpenGL 控件 
用 于 绘制 飞行 器 模型 和 三 维 空间 ,实时 描绘 飞行 器 的 状态 。 
3) progressBar 控件 
使 用 绿色 的 进度 条 来 显示 遥控 器 的 值 ,能 够 更 加 生动 、 直 观 地 反映 出 遥控 器 的 控 
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制 量 。 

4) statusChart 控件 

通过 单 击 右 侧 的 radio button 按钮 来 选择 所 要 显示 的 波形 数据 , 当 数据 开始 变化 时 ， 
控件 会 实时 绘制 出 选择 数据 类 型 的 波形 ,当选 择 好 下 面 下 拉 框 的 保存 位 置 和 采样 频率 
后 , 单 击 “ 保 存 ” 按 钮 , 即 可 以 保存 接 下 来 的 200 个 数据 点 ,用 于 之 后 的 数据 处 理 分 析 。 

数据 存储 在 Excel 表格 中 ,可 由 波形 显示 模块 调用 查看 。 

4. 波形 显示 模块 

波形 显示 流程 框图 如 图 5. 5. 15 所 示 。 


波形 回放 


选择 一 个 或 者 两 
个 回放 数据 类 型 


i 


观察 之 前 存储 的 


波形 


图 5.5.15 波形 显示 流程 框图 
此 模块 的 主体 是 usercontrol 控件 模块 ,是 单独 自己 定义 的 一 个 模块 ,该 模块 在 通过 
选择 波形 类 型 和 数据 编号 之 后 ,可 以 调用 存储 在 Excel 表格 里 面 的 数据 ,绘制 成 波形 ,来 


显示 之 前 存储 的 数据 ,并 合理 地 绘画 出 刻度 值 。 如 果 勾 选 两 个 数据 , 则 会 绘画 出 颜色 不 
同 的 线条 ,从 而 方便 比较 两 次 飞行 的 好 坏 程度 。 
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6.1 飞行 控制 板 PCB 板 制作 与 调试 技术 


在 Altium Designer 10 设计 环境 中 原理 图 设计 完成 ,并 经 校 验 无 误 后 便 可 以 转 入 印 
制 电路 板 (Printed Circuit Board, PCB) 的 设计 ,一 般 的 PCB 设计 流程 框图 如 图 6. 1. 1 
所 示 。 


设计 原理 图 


1 
1 布线 规则 设置 
定义 元 件 封装 
1 自动 布线 
PCB 图 纸 基本 
设置 1 
手动 布线 
! 
生成 网 表 和 加 1 
ICE 生成 报表 文件 
1 Y 
更 新 PCB 文件 打印 输出 
q 1 
元 件 布局 PCB 设 计 结束 


图 6.1.1 PCB 设计 的 一 般 流程 框图 
在 将 原理 图 设计 转变 为 PCB 设计 之 前 ,需要 创建 一 个 新 的 PCB 和 至 少 一 个 板 外 形 
轮廓 (Board Outline) 。 在 Altium Designer 中 创建 一 个 新 的 PCB 的 最 简单 方法 就 是 运用 
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PCB 向 导 , 它 可 让 用 户 根 据 行 业 标 准 选择 自己 创建 的 自 定义 板 的 大 小 。 在 任何 阶段 ,都 
可 以 使 用 后 退 按钮 检查 或 修改 该 向 导 的 之 前 页 面 。 将 原理 图 导入 PCB 前 要 确保 所 有 与 
原理 图 和 PCB 相关 的 元 件 库 是 可 用 的 。 因 为 只 有 默认 安装 的 集成 库 被 用 到 ,所 以 封装 已 
经 被 包括 在 内 。 如 果 工 程 已 经 编译 并 且 原 理 图 没有 任何 错误 , 则 可 以 使 用 Update PCB 
命令 来 产生 ECO(Engineering Change Orders, 工程 变更 命令 ), 它 将 把 原理 图 的 信息 导 
和 到 目标 PCB 文件 。 导 入 原理 图 生成 的 网 格 表 之 后 , 便 可 对 元 器 件 进行 拖 动 布局 。 在 板 
上 摆 放 元 器 件 之 前 ,需要 对 PCB 工作 环境 进行 相关 设置 ,如 栅 格 、 层 以 及 设计 规则 。PCB 
编辑 工作 环境 允许 PCB 设计 在 二 维 及 三 维 模式 下 表现 出 来 。 

在 PCB 设计 中 ,布局 是 一 个 重要 的 环节 。 布 局 的 好 坏 将 直接 影响 布线 的 效果 ,因此 
可 以 认为 合理 的 布局 是 PCB 设计 成 功 的 第 一 步 。 布 局 的 方式 分 为 两 种 : 一 种 是 交互 式 
布局 ; 另 一 种 是 自动 布局 。 一 般 是 在 自动 布局 的 基础 上 用 交互 式 布 局 进行 调整 。 在 布局 
时 还 要 根据 布线 的 情况 对 元 器 件 、 门 电路 及 引 脚 进行 青 分 配 ,使 其 成 为 便于 布线 的 最 佳 
布局 。 在 布局 完成 后 ,还 可 将 设计 文件 及 有 关 信 息 进行 回 注 , 使 得 PCB 中 的 有 关 信 息 与 
原理 图 保持 一 致 ,以 便 使 今后 的 建 档 、 更 改 设计 能 同步 ,同时 对 模拟 的 有 关 信 息 进行 更 
新 ,使 得 能 对 电路 的 电气 性 能 及 功能 进行 板 级 验证 。 

在 PCB 布局 过 程 中 ,首先 要 考虑 的 是 PCB 尺寸 大 小 ,PCB 尺寸 过 大 时 印 制 线路 长 ， 
阻抗 增加 , 抗 噪声 能 力 下 降 , 成 本 也 会 增加 ; 尺寸 过 小 , 则 散热 不 好 , 且 邻 近 线条 易 受 干 
扰 。 其 次 ,在 确定 PCB 尺寸 后 ,要 确定 特殊 元 器 件 的 位 置 。 最 后 ,根据 电路 的 功能 单元 ， 
对 电路 的 全 部 元 器 件 进 行 布 局 。 

图 6. 1. 2 所 示 为 布局 好 的 飞行 控制 板 PCB 图。 

考虑 到 四 旋 鄙 飞行 器 工作 的 特点 ,设计 应 采用 小 巧 、. 轻 便 的 贴 片 元 器 件 , 这 样 可 以 尽 
量 缩小 板子 的 体积 以 满足 飞行 器 对 重量 的 要 求 , 合 理 安排 各 方面 的 接口 电路 以 便 与 机 架 
进行 组 装 和 后 续 的 调试 。 根 据 规 则 手动 布局 好 元 器 件 位 置 。 

特别 应 当 注意 的 一 点 是 ,由 于 飞行 控制 板 采用 了 6 轴 传 感 器 MPU6050 模块 ,来 获取 
角度 数据 ,通过 PID 和 姿态 解 算 进 行 飞行 ,因此 对 该 模块 放置 的 位 置 有 严格 的 要 求 。 放 
置 角度 应 使 该 飞行 控制 板 所 对 应 的 四 旋 辟 飞行 器 飞行 模式 属于 X 形 ,应 尽量 保证 
MPU6050 模块 位 于 PCB 的 中 央 , 且 在 飞行 器 静止 时 处 于 水 平 状态 。 

Altium Designer 10 提供 了 详尽 的 10 种 不 同 的 设计 规则 ,这 些 设 计 规 则 包括 导线 放 
置 . 导 线 布线 方法 .元 件 放置 ,布线 规则 、 元 件 移动 和 信号 完整 性 等 规则 。 根 据 这 些 规则 ， 
系统 进行 自动 布局 和 自动 布线 。 其 中 重要 的 规则 如 走 线 宽度 Width 要 根据 信号 线 承载 
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图 6.1.2 布局 好 的 飞行 控制 板 PCB 
的 电流 大 小 进行 合理 设置 , 走 线 的 间隔 Clearance 距离 影响 到 信号 间 的 稳定 ,也 要 对 其 进 
行 合理 的 设置 。 由 于 本 次 设计 是 双 面 板 ,很 多 规则 可 以 按照 系统 默认 的 设置 。 设 置 好 的 
关键 规则 如 图 6. 1. 3 所 示 。 


Bue Type: 

[Pro | Enabled] Name (Scope. Mrbues ] 
1 Iara v) Pref Width = 20m Min Width = 6m Max Width =25mi 
2 Wy iers) Prel width = 24ml Min Width « &mil Max Width = 25mil 
3 回 wih AI Pref width = 10m Min Width = 6md Max Width = 25mil 

Bute Type 

Prionty | Enabled Name [Scope J 
1 Polygon inPoygon - AP  Clexance = l0mi 
2 M Clearance Al AN Cleaance = mi 


6.1.3 关键 设计 规则 设置 
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Altium Designer 设计 环境 的 自动 布线 是 靠 前 面 设置 好 的 规则 来 进行 的 ,因此 布局 完 
成 和 设置 好 设计 规则 后 便 可 以 进行 自动 布线 ,自动 布线 能 最 大 限度 地 提高 布 通 率 ,对 于 
非 高 频 板 可 以 采用 先 自动 布线 后 手动 更 改 优化 的 方法 。 执 行 Auto Route AIL 命令 ,在 
弹出 的 对 话 框 中 定义 板子 的 走 线 方 向 和 布线 策略 。 本 设计 是 双 层 PCB ,定义 走 线 方向 项 
层 为 水 平 走向 ,底层 为 垂直 走向 ,这 样 设 计 可 以 减少 层 间 的 电磁 干扰 ,提高 电磁 兼容 人 性， 
布线 策略 采用 系统 默认 的 双 层 板 布线 策略 ,然后 单 击 Route All 开始 自动 布线 。 自 动 布 
线 完 成 后 可 以 针对 不 理想 的 地 方 进行 手动 更 改 优 化 ,直至 100% 布 通 为 止 。 

布线 完成 后 就 可 以 进一步 完善 板子 的 设计 ,如 补 泪 滴 和 和 覆 铜 。 泪 滴 即 在 导线 和 焊 盘 
或 导 孔 之 间 的 一 段 过 渡 , 过 渡 的 地 方 呈 泪 滴 状 ,其 可 以 保护 焊 盘 ,避免 在 导线 与 爆 盘 的 接 
和 触 点 处 出 现 应 力 集中 而 断裂 。 通 过 Tools 菜单 中 的 Tearsdrops 命令 进行 补 泪 滴 的 操作 ， 
如 图 6. 1.4 所 示 。 


General 
I| Pads 
I Vias 
F Selected Objects Only 


E Force Teardiops. 
E Create Repot 


图 6.1.4 补 泪 滴 操 作对 话 框 


覆 铜 就 是 将 PCB 上 闲置 的 空间 作为 基准 面 , 然 后 用 固体 铜 填充 ,这 些 铜 区 又 称 为 灌 
铜 。 数 铜 的 意义 在 于 : 减 小 地 线 阻抗 ,提高 抗 干扰 能 力 ; 降低 压 降 ,提高 电源 效率 ; 与 地 
线 相连 , 减 小 环 路 面积 。 执 行 Place Polygon Pour 命令 ,打开 覆 铜 设置 对 话 框 进行 设置 ， 
确定 后 就 可 以 进行 覆 铜 操作 了 ,顶层 和 底层 均 要 覆 铜 。 

由 于 设计 的 PCB 用 的 是 表 贴 片 元 器 件 封装 , 同 传统 的 封装 相 比 , 它 可 以 减少 电路 板 
的 面积 ,易于 大 批量 加 工 , 布 线 密度 高 。 焊 接 时 一 般 遵 循 以 下 顺序 : 看 体积 , 先 小 后 大 ; 
看 板 型 , 先 里 后 外 ; 看 规格 , 先 表 贴 片 元 器 件 后 直 插 式 元 器 件 。 

焊接 完成 后 ,就 要 进行 测试 。 在 上 电 之 前 先 用 万 用 表 的 欧姆 挡 测量 一 下 板子 上 的 电 
源 接口 是 否 有 短路 的 情况 ,无 短路 后 才能 上 电 测 试 ,用 二 Link 硬件 仿真 器 通过 JTAG A 
与 板子 相连 ,运行 LinkCommander 测试 飞行 控制 板 是 否 能 被 计算 机 识别 ,然后 在 Keil 
开发 环境 下 编写 一 个 简单 的 测试 程序 。 
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6.2 四 旋 杜 飞行 器 的 组 装 


6.2.1 飞行 器 的 组 装 步骤 


无 人 机 安装 所 需 部 件 如 图 6. 2. 1 所 示 ,安装 步骤 如 下 。 
CD 将 电机 导线 焊接 上 香 巷 头 公 头 ,用 于 后 续 与 电子 调 速 器 连接 ,如 图 6. 2. 2 所 示 。 


LÀ 
Fl 6.2.1. 无 人 机 安装 所 需 部 件 图 6.2.2 电机 与 香 奉 头 烛 接 示意 图 


© 将 电机 固定 在 电机 座 上 ,如 图 6. 2. 3 所 示 。 
© 将 电机 座 与 机 臂 相互 连接 ,如 图 6. 2. 4 所 示 。 


CD. 完成 机 架 的 安装 ,注意 电机 的 螺纹 方向 , 顺 时 针 螺纹 的 电机 安装 在 机 架 的 左 后 方 
和 右前 方 , 另 一 组 电机 安装 在 剩余 两 个 方向 ,如 图 6. 2. 5 所 示 。 


图 6.2.3 电机 安装 在 电机 座 示 意图 


图 6.2.4 电机 与 机 臂 互 连 示 意图 
C) 连接 电机 和 电 调 ( 先 随意 连接 ,后 续 再 进行 转向 调整 ), 如 图 6. 2. 6 所 示 。 


© 将 电 调 线 和 电源 线 焊接 在 分 压板 的 相应 位 置 ,并 固定 分 压板 、 电 源 线 、 电 子 调 速 器 
等 ,同时 从 分 压板 上 引出 5V 输出 ,如 图 6. 2.7 所 示 。 
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图 6.2.5 机 架 示 意图 图 6.2.6 电 调 与 电机 相连 示意 图 


CD 根据 无 人 机 设 定 方向 ,放置 和 固定 飞行 控制 模块 ,并 将 5V 电源 线 、 电 调 信号 线 与 
飞行 控制 模块 相连 ,如 图 6. 2. 8 所 示 。 

© 安装 各 类 传感器 。 装 好 飞机 之 后 ,首先 要 进行 电 调 初始 化 ,设置 各 电 调 的 上 下 限 
输出 ,以 实现 同步 ,之 后 就 开始 调整 电机 的 转向 了 。 首 先 要 了 解 飞 机 对 角 的 转向 相同 , 相 
邻 的 转向 相反 ,这 样 才能 抵消 飞机 的 自 旋 。 注 意 调整 转向 时 ,一 定 要 拆 下 浆 。 从 1 号 (X 
轴 的 左边 ) 电 机 开始 作为 起 点 ,来 判断 2、3、4 号 电机 方向 。 接 通电 源 , 把 遥控 油门 开 到 最 
低 , 以 使 转速 最 低 , 打 开 遥 控 开 关 , 观 察 顺 逆 方 向 ,操作 2 一 3 次 验证 。 若 与 预期 方向 相 
反 , 则 改变 3 根 信 号 线 中 的 任意 两 根 信号 线 香蕉 头 的 接 向 。 剩 下 的 与 电机 调试 方法 
相同 。 


图 6.2.7 电源 线 、 分 压板 等 安装 示意 图 图 6.2.8 飞行 控制 模块 安装 示意 图 


6.2.2 新 组 装 四 旋翼 飞行 器 的 第 一 次 调试 过 程 


新 组 装 成 的 四 旋 巡 飞 行 器 在 第 一 次 通电 前 , 先 卸 下 螺旋 桨 ,用 万 用 表 确 认 电 源 输入 
正 负极 两 端 没有 短路 情况 下 接 上 电池 ,观察 各 个 模块 供电 是 否 正常 ,无 异常 则 进行 以 下 
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步骤 。 

1. 电 调 (电子 调 速 器 ) 行 程 范 围 设置 

电 调 初始 化 就 是 设 定 电 调 的 最 高 转速 和 最 低 转速 ,使 4 个 电 调 实现 对 PWM 波 解析 
的 同步 ,使 四 旋 潜 飞机 能 够 实现 平衡 和 稳定 。 电 调 一 般 选 择 比 电机 电流 大 3 一 4 倍 为 好 
(如 5A 电机 则 选择 20A 电 调 ) ,电机 转速 的 控制 是 单片机 输出 PWM 到 电 调 ,PWM 的 脉 
冲 宽度 控制 转速 , 电 调 与 电机 连接 的 3 根 线 的 接 法 控制 电机 转动 的 方向 , 若 转动 方向 不 
对 ,3 根 线 中 任意 两 根 线 的 交换 连接 就 会 使 电机 反 转 。 电 调 行程 范围 设置 的 PWM 波 要 
求 根据 型 号 查看 电子 调 速 器 使 用 说 明 书 。 校 准时 电 调 发 出 两 个 " 哗 ? 声 ,表示 最 大 、 最 小 
油门 捕获 ,然后 就 会 听 到 几 个 “* 哗 ? 声 ( 每 一 声 代表 所 使 用 的 电池 的 一 芯 ), 随 后 一 个 长 
“ 哗 ?” 声 表示 电 调 已 校准 。 为 了 方便 快速 ,一 般 通 过 编写 初始 化 电 调 程序 对 它们 行程 范围 
进行 设置 ,运行 程序 后 当 听 到 “ 咬 咬 , 咬 咬 咬 , 喷 " 声 后 表明 设置 成 功 。 

测试 电机 。 在 已 经 校准 了 电 调 之 后 ,可 以 插 上 电池 测试 它们 ,此 处 还 是 不 要 安装 螺 
旋 桨 。 为 了 便于 初学 者 掌控 飞行 ,将 飞行 器 设置 成 * Attitude 模式 ”, 这 样 遥 控 器 油门 杆 
控制 自 旋 后 松 开 飞 机 又 能 回 到 原 方向 ; 将 遥控 器 设置 成 自 稳 模 式 , 这 样 在 用 roll 与 pitch 
操作 控制 飞行 器 的 倾斜 角度 后 , 松 开 roll 与 pitch 摇 杆 时 ,飞行 器 将 会 自动 水 平 。 

飞行 器 放 在 较 水 平 的 地 面 上 ,解锁 飞行 器 ,给 一 个 小 量 的 油门 ,所 有 电机 应 该 以 大 致 
相同 的 速度 旋转 ,并 且 它 们 起 转 也 应 该 在 同一 时 间 。 如 果 电 机 没有 在 相同 的 时 间 起 转 ， 
旋转 也 不 在 同一 速度 ,那么 电 调 仍 没有 正确 校准 。 当 电机 工作 正常 后 ,前 后 左右 倾斜 飞 
行 器 时 ,观察 不 同位 置 的 电机 转速 是 否 能 相应 做 出 正确 调整 。 

起 飞 时 的 常见 问题 。 电 机 测试 正常 后 就 可 以 开始 起 飞 了 ,这 时 要 注意 飞机 放 在 起 飞 
位 置 后 才 插 电 , 是 为 了 确定 飞行 器 的 Attitude 正方 向 位 置 ,起 飞 时 可 能 会 遇 到 以 下 问题 。 

(D 刚 装 的 飞行 器 在 起 飞 时 秒 翻 。 

通常 是 电机 顺序 错误 、 电 机 转动 方向 错误 或 者 螺旋 桨 方向 ( 顺 时 针 或 者 逆 时 针 ) 安 装 
错误 造成 的 。 

© 飞行 器 在 roll 或 者 pitch 方向 上 来 回 晃动 。 

通常 意味 着 PID 参数 值 不 对 ,请 参阅 PID 调节 部 分 来 正确 调整 参数 。 

© 飞行 器 在 快速 下 降 时 来 回 晃动 。 

这 是 飞行 器 在 快速 下 降 时 螺旋 桨 的 惯性 转动 所 导致 ,增加 roll 或 pitch 的 P 值 可 能 
会 有 所 改善 。 

© 飞行器 在 起 飞 时 向 左 或 者 向 右 自 旋 一 定 角度 。 
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这 可 能 是 因为 某 些 电 机 没有 垂直 安装 或 者 电 调 没有 校准 成 功 。 

C) 飞行 器 总 是 在 无 风 的 环境 中 朝 着 某 一 个 方向 漂移 。 

如 果 只 是 起 飞 时 偏 , 飞 至 空中 后 姿态 能 自动 调整 稳定 , 那 是 由 于 在 无 人 机 姿态 控制 
中 I 值 为 0 时 ,飞行 器 重心 偏 移 所 致 。 如 果 飞 行 器 在 空中 总 是 朝 着 某 一 个 方向 飘 ,就 用 还 
控 器 上 加 减 微 调 值 或 在 飞行 控制 控制 姿态 程序 中 在 相应 姿态 方向 上 增加 固定 偏 移 量 。 
要 特别 强调 的 是 ,因为 电池 较 重 , 它 的 安装 位 置 是 决定 飞机 重心 的 关键 因素 ,所 以 一 定 要 
根据 飞机 重心 选择 最 佳 位 置 并 且 每 次 安装 都 一 致 

@ 飞行 器 在 空中 无 法 完美 地 保持 高 度 位 置 。 

在 没有 测 高 传感器 的 情况 下 ,在 自 稳 模 式 下 想 要 定 高 定点 ,必须 不 断 用 遥控 器 修正 
飞行 器 姿态 。 在 装 有 测 高 传感器 时 ,一 般 是 测 高 数据 没有 滤波 或 PID 参数 没有 调整 好 。 

2. 遥控 器 参数 设置 

遥控 器 采用 9 通道 2. 4GHz 接收 机 ，4096 分 辨 率 ( PCMS 4096 制式 下 ) ,在 遥控 飞 
机 前 需要 设置 控制 值 范围 。 

O 正 反 设 置 。 调 遥控 器 操纵 杆 的 控制 方向 的 正 反 。 

© 舵 角 设置 。 调 上 下 限 。 下 限 674, 上 限 1467. 

© 辅助 设置 。 调 中 值 ,1071 。 

QD 遥控 器 关 674 3E FE SR OCOT. 1467, 另 外 还 有 表 6. 2. 1 中 4 个 通道 的 值 。 


表 6.2.1 遥控 器 通道 配置 


通道 最 小 中 值 最 大 
WE CAE 634 1072 1434 
升降 (前 后 ) 590 1072 1411 
油门 (高 低 ) 589 1049 1398 
方向 ( 偏 航 ) 634 1072 1434 

其 他 在 调试 时 总 结 的 经 验 如 下 。 


在 飞行 控制 程序 中 添加 当 飞 机 撞 物 致使 飞机 倾斜 大 于 45°" 时 让 浆 停 转 ; 人 为 遥控 
飞机 或 在 飞行 控制 程序 高 度 PID 尚未 调试 完成 前 当 飞机 达到 危险 高 度 时 立即 自动 运行 
紧急 降落 程序 。 

@ 遥控 器 与 飞机 一 旦 飞 出 遥控 范围 或 故障 导致 通信 中 断 ,飞行 控制 程序 中 应 加 入 立 
刻 启动 自 保护 的 飞机 紧急 降落 程序 。 


第 6 章 ”四 旋 愤 飞行 器 制作 及 调试 方法 | 137 


O 超声 波 安装 时 ,如 果 用 立柱 螺钉 安装 在 机 架 上 ,起 飞 后 机 架 的 抖动 会 使 超声 波 跟 
随 着 机 械 装置 发 生 振 动 ,使 得 高 度数 据 不 稳 。 应 该 用 海绵 包 囊 超 声波 ,然后 用 双 面 胶 将 
其 粘 在 机 架 上 ,起 到 避 振 的 效果 ,这样 就 可 以 避免 超声 波 在 静态 时 测量 正常 ,而 在 起 飞 后 
高 度数 据 乱 跳 的 现象 。 

@ 如 果 有 几 组 人 员 都 在 相 邻 的 场地 上 调试 飞机 ,遥控 无 线 通信 用 的 都 是 nRF 模块 ， 
为 了 使 各 个 组 之 间 调 试 不 致 相互 影响 ,nRF 模块 初始 化 时 应 将 通道 号 错开 。 


6.3 常见 调试 问题 与 解决 方案 


6.3.1 PID 参数 调整 经 验 


PID 参数 调节 最 直观 的 方法 就 是 通过 波形 图 来 观察 调节 的 规律 。 本 系统 在 进行 高 
JE PID 和 位 移 PID 参数 调节 时 ,将 调节 对 象 的 实时 数据 发 送 回来 ,在 上 位 机 中 显示 其 变 
化 的 波形 ,通过 观察 波形 变化 的 规律 来 细 调 PI、D 这 3 个 参数 。 具 体 调节 时 可 以 参照 下 
面 的 PID 整定 口诀 : 

参数 整定 找 最 佳 ,从 小 到 大 顺序 查 。 
先是 比例 后 积分 ,最 后 青 把 微分 加 。 
曲线 振荡 很 频繁 ,比例 度 盘 要 放大 。 
曲线 漂浮 绕 大 弯 , 比 例 度 盘 往 小 扳 。 
曲线 偏离 回复 慢 ,积分 时 间 往 下 降 。 
曲线 波动 周期 长 ,积分 时 间 再 加 长 。 
曲线 振荡 频率 快 , 先 把 微分 降下 来 。 
动 差 大 来 波动 慢 , 微 分 时 间 应 加 长 。 
理想 曲线 两 个 波 ,前 高 后 低 四 比 一 。 
一 看 二 调 多 分 析 ,调节 质量 不 会 低 。 

最 后 整定 好 PID 参数 后 ,得 到 的 波形 图 应 该 类 似 图 6. 3. 1。 图 6. 3. 1 是 飞行 器 高 度 
控制 PID 参数 调 好 后 的 实时 高 度数 据 波形 图 ,最 上 面 的 那 条 波形 是 飞行 器 的 油门 值 ,中 
间 部 分 是 飞行 器 的 实时 高 度 值 ,最 下 面 是 高 度 控 制 PID 调节 器 的 输出 值 , PID 调节 器 中 
输入 当前 高 度 和 目标 高 度 的 误差 ,输出 调节 值 , 作 用 在 飞行 器 的 油门 上 ,最 终 使 飞行 器 的 
高 度 保持 在 目标 高 度 附近 上 下 抖动 ,实现 飞行 器 的 自动 定 高 功能 。 
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图 6.3.1 高 度 调节 波形 

此 外 ,也 可 以 使 用 凑 试 法 进行 PID 调节 , 它 的 优点 是 要 求 较 低 、 操 作 简单 易 行 。 测 试 
时 ,对 参数 实行 先 比例 、 后 积分 、 再 微分 的 整定 步骤 ,具体 如 下 。 

C 先 调节 比例 部 分 。 确 定 比 例 系数 Kp 时 ,首先 去 掉 PID 的 积分 项 和 微分 项 (即今 
Ki 二 0、Ko 王 0) ,使 之 成 为 纯 比 例 调节 。 输 入 设 定 为 系统 允许 输出 最 大 值 的 60% — 7026. 
比例 系数 Ke 由 0 开始 逐渐 增 大 ,直至 系统 出 现 振荡 ; 再 反 过 来 ,从 此 时 的 比例 系数 K p 
渐 减 小 ,直至 系统 振荡 消失 , 且 系 统 反应 快 。 记 录 此 时 的 比例 系数 Kr, 设 定 PID 的 比例 
系数 Ks 为 当前 值 的 60% — 7026 

© 加 入 积分 控制 。 如 果 在 比例 调节 的 基础 上 系统 的 静 差 不 能 满足 设计 要 求 , 则 需 加 
入 积分 环节 。 调 节 时 首先 置 积分 系数 Ki 为 一 较 大 值 ,并 将 经 第 一 步 得 到 的 比例 系数 略 委 
缩小 (如 缩小 为 原 值 的 0. 8 倍 ) ,然后 减 小 积分 时 间 , 使 在 保持 系统 良好 动态 性 能 的 情况 
下 ,静态 误差 得 到 消除 。 

© 加 入 微分 控制 。 若 使 用 比例 积分 调节 器 消除 了 静态 误差 ,但 动态 过 程 经 反复 调整 
仍 不 能 满意 , 则 可 加 入 微分 环节 ,构成 比例 积分 微分 调节 器 。 在 调整 时 ,可 先 置 微分 系数 
Ko 为 0。 在 第 (2) 步 整定 的 基础 上 , 增 大 Ko ,同时 相应 地 改变 比例 系数 和 积分 系数 ,逐步 
凑 试 ,以 获得 满意 的 调节 效果 和 控制 参数 。 

了 解 了 以 上 两 种 PID 调试 方法 后 ,解释 一 下 PID 参数 调整 的 依据 。 

CD 在 偏差 比较 大 时 ,为 使 尽快 消除 偏差 ,提高 响应 速度 ,同时 为 了 避免 系统 响应 出 现 
EI, KAKE, K RE; 在 偏差 比较 小 时 ,为 继续 减 小 偏差 ,并 防止 超 调 过 大 产生 振 


N 


kj 
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荡 、 稳 定性 变 差 ,Kp 值 要 减 小 ,Ki 取 小 值 ; 在 偏差 很 小 时 ,为 消除 静 差 ,克服 超 调 ,使 系统 
尽快 稳定 ,Ks 值 继续 减 小 ,Ki 值 不 变 或 稍 取 大 值 。 

@ 当 偏 差 与 偏差 变化 率 同 号 时 ,被 控 量 是 朝 偏 离 既 定 值 方 向 变化 ,而 当 偏差 与 偏差 
变化 率 异 号 时 ,被 控 量 朝 既定 值 方 向 变化 。 当 被 控 量 接近 定 值 时 , 异 号 的 微分 作用 阻碍 
积分 作用 ,避免 积分 超 调 及 随 之 而 来 的 振荡 ,有 利于 控制 ; 而 当 被 控 量 远 未 接近 各 定 值 并 
向 定 值 变化 时 , 则 由 于 比例 作用 和 微分 作用 反 向 ,将 会 减 慢 控 制 过 程 。 在 偏差 比较 大 时 ， 
偏差 变化 率 与 偏差 异 号 时 ,Ko 值 取 零 或 负 值 ,以 加 快 控制 的 动态 过 程 。 

© 偏差 变化 率 的 大 小 表明 偏差 变化 的 速率 ,e(z) 一 e(t 一 1) 越 大 ,Ko 取 值 越 小 ,Ki 取 
值 越 大 ; 反之 亦 然 。 同 时 ,要 结合 偏差 大 小 来 考虑 。 

下 面 介 绍 一 种 PID 参数 半自动 整定 方法 。 

在 本 应 用 中 采用 的 PID 参数 整定 方法 为 临界 比例 度 法 ,比例 度 S= 1/ Kp ,积分 时 间 
Ty— dt/ Ky MAAE T, = dt * Ko ,其 中 de 为 PID 调节 周期 。 

根据 临界 比例 度 整 定 法 ,将 Kt 和 Ko 管 零 后 选择 合适 的 $, 使 无 人 机 在 调整 方向 上 出 
现 等 幅 振 荡 ,此 时 9》 记 为 6k, 记 此 时 无 人 机 的 振荡 周期 为 Tho DU iz e ode HA 8 Ti To 
值 的 关系 如 表 6. 3. 1 所 示 。 


表 6.3.1 临界 比例 度 整 定 算法 


6 Ti/min Tp/min 


1.6 à, 0. 5T, 0. 25 Ti 


完成 该 算法 的 核心 代码 如 下 : 


Tk = timeused / (600.0 * n); 

Ti = 0.5 * Tk; 

Td = 0.25 * Ti; 

Switch (PID radiogroup. getCheckedRadioButtonld()) 

t 

case R. id.rosx radiobtn: 
deltak - 1.6 / (Double.valueOf(posx P txt.getText(). toString())); 
break; 

case R. id. posy radiobtn: 
deltak - 1.6 / (Double.valueOf(posy P txt.getText(). toString())); 
break; 

default: 
break; 

) 
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Kp = 1/deltak; 
Ki = 0.025 x 1/Ti; 
Kd - Td/0.025; 


另外 ,还 需要 注意 的 是 无 人 机 的 PID 调节 同 温度 调节 阀门 调节 等 PID 调节 有 很 大 的 
不 同 ,无 人 机 的 PID 调节 不 仅 要 让 输出 结果 恒定 在 一 个 值 附 近 , 输 出 值 还 不 能 拥有 高 频 
拌 动 ,如 果 存 在 高 频 拌 动 ,无 人 机 很 可 能 就 会 失控 。 因 此 在 无 人 机 的 PID 调试 中 ,数据 的 
平滑 变动 是 最 为 重要 的 ; 否则 就 有 可 能 不 可 避免 地 增加 输出 的 波动 范围 。 


6.3.2. 减少 机 械 振动 以 提高 飞行 稳定 性 


RESE KITAR 4 个 轴 的 桨 避 应 处 于 同一 高 度 平 面 , 轴 的 中 心 处 安放 飞行 控制 部 分 ， 
以 使 得 整个 四 轴 重 心 稳定 。 轴 经 应 固定 安放 在 机 身 的 4 个 轴 的 末端 。 

在 PCB 设计 时 , 钻 孔 应 设计 得 稍微 大 一 些 , 便 于 安放 避 振 垫 片 。 由 于 飞行 控制 板 上 
所 安放 的 传感器 都 有 很 高 的 精度 ,因此 机 身 的 振动 会 对 它们 的 读数 造成 误差 。 安 放 垫 片 
可 以 分 散 机 身 与 其 他 部 分 接触 的 压强 ,起 到 避 振 的 作用 , 减 小 了 对 传感器 读数 的 影响 。 

同时 ,对 于 连接 在 飞行 控制 板 外 部 的 传感器 模块 ,如 超声 波 模块 ,其 实时 读数 可 以 判 
断 飞 机 的 当前 高 度 。 应 在 其 周边 贴 上 海绵 来 减少 振动 带 来 的 高 度 误差 。 


成 功 案例 


7.1 竞赛 作品 1 
设计 竞赛 


2015 年 ( 瑞 萨 杯 ) 全 国 大 学 生 电子 


7.1.1 题目 要 求 


设计 并 制作 一 架 带 航拍 功能 的 多 旋翼 自主 飞行 器 。 飞 行 区 域 俯视 图 和 立体 图 分 别 
如 图 7. 1.1 和 图 7. 1. 2 所 示 。 
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图 7.1.1 飞行 区 域 俯视 图 (单位 : cm) 
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图 7.1.2 飞行 区 域 立体 示意 图 (单位 : cm) 


1. 基本 要 求 

O 多 旋翼 自主 飞行 器 (下 简称 飞行 器 ) 摆 放 在 图 7. 1.1 所 示 的 A 区 ,开启 航拍 ,一 键 
式 启动 ,飞行 器 起 飞 ; 飞 向 B 区 ,在 B 区 中 心 降落 并 停机 ; 航拍 数据 记录 于 飞行 器 自 带 
的 存储 卡 中 ,飞行 结束 后 可 通过 PC 回放 。 飞 行 高 度 不 低 于 30cm; 飞行 时 间 不 大 
3-308. 

© 飞行 器 摆 放 在 图 7.1.1 所 示 的 A 区 ,一 键 式 启动 ,飞行 器 起 飞 ; 沿 和 矩形 CDEF 3i 
时 针 飞 行 一 圈 , 在 A 区 中 心 降落 并 停机 ; 飞行 高 度 不 低 于 30cm; 飞行 时 间 不 大 于 45s。 

© 制作 一 个 简易 电子 示 高 装置 ,产生 示 高 线 hh、hs( 如 激光 等 ) ,hh 、hs 位 于 同一 垂直 
平面 ,飞行 器 触 碰 hi .hs 线 时 该 装置 可 产生 声 光 报 警 。 示 高 线 hi 、h, 的 高 度 在 测试 现场 可 
以 调整 。 调 整 范围 为 30 一 120cm。 

2. 发 挥 部 分 

(D 飞行 器 摆 放 在 A 区 ,飞行 器 下 面 摆 放 一 小 铁 板 Ml ,一 键 式 启动 , 飞 行 器 拾取 小 铁 
板 M1 并 起 飞 。 飞 行 器 携带 小 铁 板 MI 从 示 高 线 a ,居间 飞 向 B 区 ,并 在 空中 将 小 铁 板 
M1 投放 到 B 区 中 心 ; 飞行 器 从 示 高 线 h、hs 间 飞 回 A 区 ,在 A 区 中 心 降落 并 停机 。 飞 
行 时 间 不 大 于 30s。 小 铁 板 M1 形状 不 限 ,质量 20g、100g、200g 三 挡 自选 ,质量 重 得 分 
高 。h ,hs 高 度 差 小 得 分 高 。 

© 飞行 器 摆 放 在 A 区 ,小 铁 板 M2 摆 放 在 B 区 任意 位 置 ; 一 键 式 启动 ,飞行 器 飞 
到 B 区 寻找 并 拾取 小 铁 板 M2 ,携带 小 铁 板 M2 飞 回 A 区 ,在 A 区 中 心 降 落 并 停机 。 飞 
行 高 度 不 低 于 30cm; 飞行 时 间 不 大 于 30s。 小 铁 板 M2 为 边 长 5cm 的 正方 形 , 重 量 
不 限 。 
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7.1.2 系统 方案 


本 系统 主要 添加 和 修改 了 控制 模块 、 薄 铁 片 拾取 模块 、 循 迹 模块 。 下 面 分 别论 证 这 
几 个 模块 的 选择 。 

1. 控制 系统 的 选择 

依据 本 题目 的 要 求 , 本 系统 选用 组 委 会 提供 的 瑞 萨 的 R5F100LEA 单片机 作为 主 控 
芯片 来 控制 飞行 器 的 飞行 姿态 与 方向 。 

2. 循 迹 模块 的 选择 

一 般 而 言 ,需要 识别 地 面 上 的 图 像 信息 ,需要 在 无 人 机 上 安装 摄像 头 ,对 摄像 头 拍摄 
的 图 像 进 行 分 析 和 处 理 。 在 本 题目 中 ,飞机 循 线 飞行 只 利用 到 了 摄像 头 一 个 维度 上 的 数 
据 , 考 虑 到 普通 摄像 头 数 据 量 庞 大 不 易 处 理 ,采用 线性 CCD 摄像 头 (1 像素 X128 像素 ) 
采集 图 像 , 让 无 人 机 实现 循 线 飞 行 。 

3. 薄 铁 片 拾取 的 选择 

方案 一 : 在 飞行 器 起 飞 时 由 系统 控制 机 械 辟 拾取 起 铁 片 ,到 达 B 区 放松 机 械 臂 ,投下 
薄 铁 片 。 缺 点 : 机 械 臂 重量 大 ,对 飞行 器 的 飞行 姿态 影响 较 大 , 薄 铁 片 厚度 非常 小 ,不 易 
拾取 。 

方案 二 : 采用 电磁 铁 拾取 ,用 瑞 萨 MCU 控制 电磁 铁 , 在 飞行 器 起 飞 时 吸取 铁 片 ,到 
B 区 后 投下 铁 片 。 优 点 : 电磁 铁 体积 小 而 且 有 和 较 强 的 拾取 能 力 ,操作 方便 。 

综 上 所 述 ,选择 既 经 济 又 灵活 的 电磁 铁 作 为 薄 铁 片 的 拾取 工具 ,采用 方案 二 。 


7.1.3 实现 方案 


1. 图 形 识别 

在 无 人 机 上 安装 线性 CCD 摄像 头 ,摄像 头 沿 水 平方 向 放置 ,将 摄像 头 传 回 的 一 维 灰 
度数 据 进行 二 值 化 处 理 后 ,根据 地 面 上 的 黑 线 占 用 的 所 有 连续 像素 点 的 中 间 值 ,判断 无 
人 机 相对 于 黑 线 的 左右 位 置 。 中 间 值 小 于 64, 则 无 人 机 在 黑 线 右 侧 , 若 中 间 值 大 于 64， 
则 无 人 机 在 黑 线 左 侧 。 

利用 黑 线 占用 像素 点 的 范围 和 高 度 进行 拟 合 ,可 以 计算 出 黑 线 的 实际 宽度 ,用 此 
宽度 值 判断 飞行 起 点 、 终 点 和 标志 点 ,从 而 实现 能 在 指定 的 地 点 让 无 人 机 做 出 对 应 
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动作 。 

若 线 性 CCD 的 数据 从 一 侧 的 像素 点 开始 都 为 黑色 ,而 另 一 侧 为 连续 白色 , 则 说 明 无 
人 机 处 于 正方 形 的 直角 转角 处 ,用 此 方法 判断 无 人 机 何 时 需要 转弯 。 

2. 循 迹 飞 行 控制 

( 一 键 起 飞 。 利 用 飞行 控制 板 上 的 按键 开关 实现 。 

@ 高 度 控制 。 采 用 超声 波 检测 无 人 机 高 度 ,利用 PID 调节 控制 无 人 机 定 高 。 

C) 直线 前 进 。 给 无 人 机 俯仰 方向 一 个 较 小 的 倾角 ,或 让 无 人 机 交替 前 倾 和 后 倾 。 通 
过 控制 倾角 大 小 或 前 倾 与 后 倾 的 时 间 比 例 ,使 无 人 机 以 合适 的 速度 匀速 前 行 ,使 线性 
CCD 摄像 头 能 够 正确 识别 地 面 黑 线 和 标志 。 

@ 左右 调整 。 根 据 上 文 所 述 ,由 线性 CCD 黑色 像素 点 的 中 间 值 ,可 以 判断 无 人 机 与 
地 面 黑 线 的 相对 位 置 。 根 据 中 间 值 与 所 有 像素 点 的 中 间 值 64 的 差 值 ,进行 PID 计算 ,将 
PID 的 输出 值 直 接 由 无 人 机 横 滚 方向 控制 , 即 可 让 无 人 机 保持 在 黑 线 上 方 前 进 。 

C» 转弯 控制 。 如 上 文 所 述 方法 , 当 无 人 机 检测 到 正方 形 的 弯 角 时 ,利用 无 人 机 上 六 
轴 传 感 器 测量 和 计算 得 到 精确 的 偏 航 角度 ,直接 改变 飞行 控制 程序 中 偏 航 方向 的 控制 
量 , 使 无 人 机 实现 90 的 转向 。 为 了 维持 无 人 机 转向 时 的 稳定 , 偏 航 方向 的 控制 量 改 变 应 
缓慢 循环 进行 。 

© 标志 点 动作 。 根 据 题目 要 求 ,无 人 机 要 在 固定 


开始 
的 标志 点 起 飞 ,降落 以 及 拾取 和 投放 铁 片 ,因此 需要 根 
据 CCD 测 得 的 宽度 数据 ,对 标志 点 进行 计数 ,从 而 实 。 [地 电 好 忆 
现在 规定 的 标志 点 实现 规定 的 动作 。 通电 
3. 薄 铁 片 的 丢 放 和 拾取 控制 ES 
kiraki i ea 
根据 前 文 所 述 的 标志 点 计数 ,可 以 判断 无 人 机 当 通电 
前 处 于 哪个 标志 点 之 上 。 在 规定 的 标志 点 上 ,完成 丢 s 
放 和 拾取 铁 片 的 控制 。 
电磁 铁 断 电 
在 7.1.1 节 中 ,根据 电磁 铁 的 通电 有 具有 磁性 、 断 电 


磁性 消失 的 原理 ,对 于 发 挥 部 分 0 .从 A 起 飞 时 让 单 片 

机 控制 电磁 铁通 电 , 让 飞行 器 吸取 薄 铁 片 飞 向 B 区 ,到 结束 "一 一 一 
达 B 区 后 让 电磁 铁 断 电 , 从 而 投下 薄 铁 片 ,让 其 落 到 B An 3 拾取 铁 片 流程 图 
区 ,程序 流程 图 如 图 7. 1. 3 所 示 。 对 于 发 挥 部 分 @ 则 
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让 无 人 机 飞 往 B 区 后 降落 ,控制 电磁 铁通 电 , 再 让 无 人 机 起 飞 和 返航 。 
4. 模式 切换 


题目 中 要 求 无 人 机 具有 多 项 功能 、 多 次 飞行 ,因此 ,利用 飞行 控制 板 上 的 拨 码 开关 切 
换 不 同 的 模式 ,实现 不 同 要 求 的 飞行 功能 。 


7.1.4 软 硬 件 方案 


1. 硬件 方案 

本 四 旋 深 飞行 系统 由 瑞 萨 飞行 导航 板 ` 飞 行 控制 板 、 线 性 CCD 模块 、 超 声波 模块 和 
电磁 铁 构成 ,由 瑞 萨 飞 行 导航 板 接收 和 处 理 传 感 器 数据 , 巾 飞行 控制 板 进行 飞行 控制 和 
电磁 铁 控制 。 各 个 传感器 完成 如 上 文 所 述 功能 。 硬 件 框图 如 图 7.1.4 所 示 。 


瑞 萨 飞行 导航 板 4 UART > 飞行 控制 板 


线性 超声 波 
CCD 模块 电机 电磁 铁 
图 7.1.4 硬件 框图 


2. 软件 方案 


根据 竞赛 要 求 , 无 人 机 上 必须 使 用 瑞 萨 芯 片 作为 飞行 导航 板 , 而 且 具 有 Tm4C123G 
芯片 的 飞行 控制 板 也 必 不 可 少 ,因此 软件 上 也 需要 在 两 个 平台 上 进行 编程 。 瑞 萨 芯 片 采 
用 CubeSuite 十 软件 进行 程序 的 编写 ,用 Renesas Flash Programmer V2. 01 软件 将 编写 
好 的 程序 烧 写 入 瑞 萨 芯片 。 飞 行 控制 板 则 使 用 IAR Workbench 进行 编写 和 烧 录 。 

瑞 萨 芯片 中 的 程序 实现 了 传感器 数据 的 采集 和 数据 的 预 处 理 , 如 线性 CCD 数据 的 
处 理 以 及 计算 地 面 黑 线 的 位 置 、 宽 度 、 转 角 等 ,通过 串口 将 数据 传输 到 飞行 控制 板 。 飞 行 
控制 板 中 的 程序 则 主要 实现 循 线 飞 行 的 控制 ,投放 和 拾取 铁 片 的 控制 ,以 及 实现 一 键 起 
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飞 和 不 同 模式 的 切换 等 。 瑞 萨 芯片 程序 流程 框图 如 图 7.1. 5 所 示 ,TI 芯片 程序 流程 框图 
如 图 7.1.6 所 示 。 


pa 采集 CCD 
3ms 定 时 | 一 一 | 数据 
MCU 执 行 | 采集 超声 波 
单元 定时 器 5ms 定 时 |- 一 一 | 数据 | 
与 TI 飞 控 板 
25ms 定 时 上 一 一 | 通信 
图 7.1.5 瑞 萨 芯 片 程序 流程 框图 
-— MPU6050 
2.5ms 定 时 | 一 一 | 数据 采集 
MORI | senta Sms 定 时 | 一 | 姿态 解 筑 | | 姿态 控制 
" 与 瑞 萨 飞行 声波 数据 "m" 
25ms 定 时 [| 导航 板 通 信 获取 ”站 ”| 高 度 控制 | 
CCD 数 据 Arif 
获取 控制 
图 7.1.6 TI 芯片 程序 流程 框图 
7.1.5 测试 
1. 测试 方案 


将 飞行 器 放 在 圆 形 区 域 A 或 B, 让 单片机 自主 控制 飞行 器 飞行 ,测试 过 程 中 ,逐个 功 
能 依次 进行 测试 ,观察 飞行 器 的 飞行 高 度 与 飞行 方向 和 时 间 , 若 飞行 器 不 能 按 预定 的 方 
案 飞 行 , 则 需要 对 无 人 机 的 程序 或 者 参数 进行 调整 再 次 测试 。 

2. 测试 条 件 


在 如 题 所 示 场 地 中 进行 测试 。 无 人 机 在 水 平 状态 下 ,通过 按钮 一 键 起 飞 。 
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3. 测试 结果 

经 测试 ,无 人 机 能 够 完成 直线 飞行 , 绕 正 方形 飞行 ,拾取 和 放置 小 铁 板 , 为 了 稳定 起 
见 , 绕 正方 形 飞行 时 间 较 长 。 另 外 ,由 于 电磁 铁 吸 引 范围 不 大 ,拾取 电磁 铁 对 铁 板 摆 放 位 
置 有 较 高 的 要 求 ,拾取 放置 铁 片 的 方案 能 够 实现 基本 功能 。 

4. 结果 分 析 

由 于 无 人 机 是 纯 自主 飞行 ,因此 当 多 次 飞行 电量 降低 后 ,无 人 机 容易 出 现 无 法 完成 
预定 飞行 目标 ,甚至 无 法 稳定 飞行 的 情况 。 在 没有 电量 自 适 应 调整 的 前 提 下 ,应 尽量 保 
证 采用 有 充足 电量 的 电池 进行 飞行 测试 ,并 尽量 保证 飞行 时 间 较 短 。 


7.2 竞赛 作品 2 
设计 竞赛 


2016 年 (TI 杯 ) 上 海 市 大 学 生 电 子 


7.2.1 题目 要 求 


1. 设备 要 求 

HEEJ AHL CGHED F 600mm) , 自 带 处 理 平 台 、 摄 像 头 (视角 小 于 90") ,有 无 线 遥 控 
装置 可 以 控制 起 飞 。 

2. 测试 环境 

室内 场地 (10mX10m, 高 度 10m) ,其 中 随机 放置 4 个 不 同形 状 的 标志 (黑色 ) ,包括 
大 正方 形 (50cmX 50cm)、 圆 形 ( 直 径 40cm)、 正 三 角形 ( 边 
K 40cm) ,小 正方 形 (30cmX30cm) ,如 图 7. 2. 1 所 示 。 

3. 完成 操作 

无 线 遥 控 装 置 发 出 起 飞 命令 , 飞 机 从 大 正方 形 中 心 起 
飞 ,自动 按照 圆 形 三角形、 小 正方 形 顺 序 飞 行 ,在 每 一 个 标 
志 物 上 完成 降落 和 起 飞 , 最 后 降落 到 小 正方 形 中 心 。 无 线 
遥控 装置 不 能 干预 飞行 过 程 , 仅 用 于 异常 情况 时 紧急 降落 。 图 7.2.1 场地 示意 图 
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7.2.2 系统 方案 


本 系统 主要 添加 和 修改 了 高 度 测 量 模块 ` 图 像 识 别 模块 和 室内 定位 模块 ,下 面 分 别 
论证 这 两 个 模块 的 选择 。 

1. 高 度 测量 模块 的 论证 与 选择 

方案 一 : 采用 BMP085 气压 传感器 测量 大 气压 并 转换 为 海拔 高 度 , 把 当前 的 海拔 测 
量 值 减 去 起 飞 时 的 海拔 值 , 即 得 飞机 的 离 地 高 度 。 

方案 二 : 采用 KS109 超声 波 传感器 测量 飞行 器 当前 的 飞行 高 度 。 模 块 发 出 8 个 
40kHz 的 超声 波 脉冲 ,然后 检测 回 波 信号 。 当 检测 到 回 波 信号 后 ,模块 还 要 进行 温度 值 
的 测量 ,然后 根据 当前 温度 对 测 距 结果 进行 校正 ,将 校正 后 的 结果 输出 。 

考虑 到 气压 传感器 数据 需 与 六 轴 传 感 器 数据 融合 后 输出 ,算法 耗 时 且 数 据 精 度 不 
高 ,而 超声 波 模块 虽然 只 适合 于 低空 飞行 ,但 在 低空 时 的 数据 准确 性 很 高 且 使 用 方法 简 
单 , 故 选择 方案 二 。 

2. 图 像 识 别 模块 选择 

方案 : STM32F407 处 理 器 是 基于 ARMO) Cortex "-M4 为 内 核 的 STM32F4 系列 高 
性 能 微 控制 器 ,其 采用 了 90nm 的 NVM 工艺 和 ART. ART 技术 使 得 程序 零 等 待 执行 ， 
提升 了 程序 执行 的 效率 ,将 Cortexi- MA 的 性 能 发 挥 到 了 极致 ,使 得 STM32 F4 系列 可 达 
到 210DMPIPS@168MHz。 

OV2640 摄像 头 模块 ,采用 1/4 F Clin —2. 54cm) 的 OV2640 百 万 高 清 CMOS f£ 
感 器 制作 。 具 有 高 灵 人 敏 度 ,高 灵活 性 支持 JPEG 输出 等 特点 ,并 且 可 支持 曝光 、 白 平衡 、 
色 度 \ 饱 和 度 、 对 比 度 等 众多 参数 设置 ,支持 JPEG/ RGB565 格式 输出 ,可 以 满足 不 同 场 
合 需 求 。 

综合 以 上 两 点 ,可 以 较 高 效率 地 识别 本 次 竞赛 要 求 的 图 像 。 

3. 室内 定位 模块 选择 

方案 : PX4Flow 是 一 款 智 能 光学 流动 传感器 。 传 感 器 拥有 原生 752X480 像素 分 辩 
率 , 计 算 光 流 的 过 程 中 采用 了 4 倍 分 级 和 剪裁 算法 ,计算 速度 达到 250Hz( 白 天 ,室外 )， 
具备 非常 高 的 感光 度 。 与 其 他 滑 鼠 传感器 不 同 , 它 可 以 以 120Hz( 黑 暗 , 室 内 ) 的 计算 速 
度 在 室内 或 者 室外 暗 光 环境 下 工作 ,而 不 需要 照明 LED。 本 次 利用 这 款 光 流 传感器 使 飞 
机 能 在 室内 稳定 地 飞行 与 悬 停 。 
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7.2.3 实现 方案 


1. 定 高 飞行 设计 

超声 波 模块 接收 到 数据 ,发 给 系统 并 与 设 定 值 进行 比较 、. 判 断 , 进 行 PID 计算 后 , 输 
出 值 用 于 油门 控制 ,以 达到 在 指定 高 度 平稳 悬 停 的 效果 。 

2. € ge iiit 

定点 悬 停 是 在 姿态 控制 及 高 度 控 制 的 基础 上 实现 的 ,首先 姿态 控制 使 飞机 能 够 平稳 
地 飞行 ,而 高 度 控制 是 飞行 器 保持 在 目标 高 度 上 ,最 后 通过 光 流 传感器 获取 飞行 器 的 位 
移 信 息 ,根据 当前 累计 偏 移 量 与 设 定点 的 差 值 进行 PID 调节 ,使 无 人 机 能 够 平稳 地 悬 停 
在 设 定点 附近 , 当 受 到 外 力作 用 偏 出 时 ,能 够 及 时 和 迅速 回 到 设 定点 。 

3. 图 像 识别 设计 

通过 摄像 头 采 集 到 图 像 ,进行 二 值 化 处 理 , 得 到 黑白 像素 点 ,然后 计算 出 连续 黑色 像 
素 的 周 长 和 面积 ,根据 周 长 的 平方 与 面积 的 比例 ,区 分 正方 形 、 三 角形 和 圆 形 ,对 于 大 正 
方形 与 小 正方 形 , 通 过 测试 拟 合 出 面积 与 高 度 和 图 形 所 占 像素 点 个 数 的 函数 关系 ,在 程 
序 中 计算 出 图 形 的 实际 面积 ,用 于 区 分 形状 相同 的 不 同 图 形 。 

根据 图 形 在 所 采集 图 像 中 的 位 置 ,和 高 度数 据 相 结合 ,可 以 计算 出 图 形 与 无 人 机 的 
相对 偏差 ,指导 无 人 机 在 图 形 正 上 方 悬 停 。 特 别 需 要 说 明 的 是 ,所 测 得 的 相对 偏差 还 需 
利用 无 人 机 的 倾角 进行 修正 ,以 得 到 准确 的 相对 偏差 。 

4. 起 飞 与 降落 控制 设计 

一 键 起 飞 时 ,定时 给 油门 一 个 循环 增 大 的 油门 量 , 同 时 在 上 升 过 程 中 通过 高 度 控制 ， 
使 得 飞机 稳定 在 3m 左右 的 高 度 。 而 当 飞 机 检测 到 下 落 的 图 形 标志 点 时 ,循环 降低 油门 
量 使 无 人 机 直线 安全 降落 ,降落 时 ,在 安全 、 稳 定 的 情况 下 尽量 保证 快速 下 降 , 提 高 无 人 
机 的 降落 精度 。 

5. 飞行 循 迹 设 计 

在 飞机 飞 到 指定 高 度 后 ,开始 扫描 地 面 上 的 图 像 , 由 于 摄像 头 的 视角 有 限 ,在 3m 高 
度 时 飞机 能 扫描 到 的 范围 只 有 不 到 3mX3m, 不 能 顾及 10mX10m 的 场地 上 随意 摆 放 的 
4 个 图 形 , 为 了 能 够 完成 题目 要 求 , 采 用 扇形 扫描 方案 。 
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无 人 机 在 大 正方 形 上 起 飞 之 后 ,首先 直线 进行 扫描 , 若 发 现 目标 图 形 , 则 立刻 降落 ， 
车 发 现 其 他 图 形 , 则 记录 无 人 机 当前 的 偏 航 角 和 前 进 距离 。 
无 人 机 完成 一 次 来 回 的 直线 扫描 , 回 到 原点 , 逆 时 针 方 向 旋 
转 一 定 的 角度 再 次 进行 直线 扫描 , 依 此 类 推 , 则 可 以 完成 覆 
盖 全 场 的 扫描 。 

在 一 个 图 形 上 起 降 之 后 ,车 下 一 个 目标 已 经 被 扫描 
过 , 则 立刻 从 原点 飞 往 下 一 个 目标 ; 否则 继续 向 后 进行 
扫描 。 

无 人 机 扫描 飞行 示意 图 如 图 7. 2. 2 Bron o 


7.2.4 硬件 与 程序 方案 


图 7.2.2 扫描 示意 图 


1. 硬件 方案 

本 四 旋 沟 飞行 器 控制 系统 是 由 两 片 微 处 理 器 芯片 组 成 ,分 别 是 由 TI 的 TM4C123G 
和 STM32F407 组 成 。 

飞行 控制 板 主 世 片 为 TM4C123G ,把 从 STM32 处 获取 的 数据 与 原 有 飞行 控制 程序 
融合 完成 题目 中 所 有 的 要 求 。 四 旋翼 无 人 机 的 导航 芯片 上 装 有 超声 波 传感器 Oe Dc Pe 
器 ,作用 分 别 为 定 高 和 室内 悬 停 。 四 旋翼 无 人 机 的 飞行 控制 板 上 装 有 六 轴 传 感 器 
MPU6050 模块 ,作用 是 获取 角度 数据 ,通过 PID 和 姿态 解 算 进 行 飞行 。 

图 像 处 理 模块 为 以 STM32F407 为 核心 的 自主 设计 板 , 其 上 方 还 装载 有 OV2640 fit 
像 头 ,用 于 采集 地 面 图 像 ,采集 到 数据 后 进行 一 定 的 算法 处 理 , 将 其 位 于 图 像 中 的 坐标 通 
过 串口 发 给 飞行 控制 板 。 

其 硬件 框图 如 图 7.2.3 所 示 。 

2. 软件 方案 

软件 方案 同 前 文 所 述 基 本 功能 无 人 机 的 软件 方案 类 似 , 仅 为 在 其 基础 上 ,在 定时 器 
中 断 中 加 入 竞赛 所 需 程序 ,包括 循 迹 算法 ,对 于 图 传 板 所 传 数据 的 处 理 程序 等 ,如 图 7. 2. 4 
所 示 。 
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TI 芯片 飞 控 板 "mH STM32 图 像 识 别 模块 
超声 波 光 流传 摄像 头 
KS109 感 器 OV2640 


图 7.2.3 硬件 框图 


. MPU6050 
m| 2.5ms 定 时 一 一 ”| 数据 采集 


- 5ms 定 时 -| 姿态 解 算 [一 | 姿态 控制 | 


won 定时 器 nu E | 9| 地 面 站 显示 


o 超声 波 数据 
| | 25ms 定 时 |———- 获取 | “| 高 度 控 制 
-| sen | — onem | -| 人 | 


图 像 传感器 | | isses 
上 位 移 控制 | 


图 7.2.4 软件 流程 框图 
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7.2.5 测试 


1. 测试 方案 

飞行 器 摆 放 在 大 正方 形 上 方 , 无 线 遥 控 装 置 发 出 起 飞 命令 ,飞机 从 大 正方 形 中 心 起 
飞 , 自 动 按照 圆 形 三角形、 小 正方 形 顺 序 飞 行 ,在 每 一 个 标志 物 上 完成 降落 和 起 飞 ,最 后 
降落 到 小 正方 形 中 心 。 观 察 飞机 对 于 每 个 图 案 识别 的 准确 度 ,以 及 在 图 像 上 方 的 起 飞 、 
下 降 的 准确 性 ,最 后 还 有 完成 整个 过 程 的 总 时 间 。 

2. 测试 条 件 

飞行 器 应 该 在 带 有 纹理 的 地 面 (10mX10m) 上 起 飞 , 场 地 有 随机 分 布 的 黑色 图 像 ( 如 
大 正方 形 、 小 正方 形 .三 角形 、 圆 形 ) 作 为 指示 物 引导 飞行 器 前 进 ,室内 光线 以 灯光 为 主 。 
用 秒表 记录 飞行 的 总 时 间 , 上 位 机 记录 飞机 的 飞行 高 度 。 

3. 测试 结果 

测试 结果 如 表 7. 2. 1 所 示 。 


表 7.2.1 测试 记录 表 


飞行 测试 次 序 1 2 3 4 5 
飞行 高 度 /cm 约 290 约 290 约 300 约 290 约 300 
大 正方 形 v v v v v 
圆 形 v v v v v 
三 角形 v v v v v 
小 正方 形 v v v v v 
飞行 时 间 /s 178 187 153 214 199 


7.3 上 毕业 设计 作品 1 


ERIR ER ie KITAR 


7.3.1 课题 概述 


本 课题 的 目的 在 于 实现 四 旋 绝 飞行 器 飞行 路 径 记 忆 及 目标 跟踪 ,以 及 即时 定位 与 建 
图 ,实现 飞行 器 的 完全 自主 飞行 。 
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7.3.2 硬件 系统 设计 


1. 系统 总 体 结构 
系统 硬件 框图 如 图 7. 3. 1 所 示 。 


Xtion 体 感 
传感器 
UVC 摄 像 头 | USB ) 
WiFi 模 块 
WiFi 模 块 
MPU-9150 E 飞行 控制 板 
WiFi 模 块 


超声 波 


图 7.3.1 硬件 框图 


2. 机 械 结构 

机 械 部 分 包括 超 轻 机 架 的 设计 、 动 力 系统 的 配置 。 

机 械 部 分 是 整个 系统 基础 ,对 于 本 课题 的 试验 性 质 ,机 械 部 分 必须 是 廉价 的 、 兼 顾 强 
度 、 重 量 与 可 维护 性 的 。 同 时 机 械 设计 时 还 要 考虑 一 定 的 元 余 性 ,保证 拓展 的 可 能 。 

3. 传感器 

传感器 包括 获取 飞行 器 位 姿 的 陀螺 仪 . 加 速度 传感器 .超声 波 传感器 .获取 视觉 信息 
的 摄像 头 以 及 获取 立体 视觉 的 RGBD 摄像 头 Xtion。 

4. 飞行 控制 板 

飞行 控制 板 需要 连接 多 种 传感器 ,如 IMU (Inertial Measurement Unit ,惯性 测量 单 
元 ) ,超声波 等 ,来 获取 姿态 信息 ,输出 PWM 波 控制 电子 调 速 器 ,同时 还 要 与 系统 板 建立 
可 靠 的 数据 通信 和 链 路 。 
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飞行 控制 板 上 运行 一 些 实时 性 要 求 比较 高 的 算法 ,比如 飞行 器 的 位 姿 解 算 、 自 动 稳 
定 控 制 算法 等 。 
5. 系统 控制 板 


系统 控制 板 需要 连接 摄像 头 、WiFi 模块 以 及 其 他 大 数据 量 的 传感器 以 及 通信 模块 。 
系统 控制 板 需要 运行 一 些 大 计算 量 的 算法 ,比如 即时 定位 于 建 图 (Slam) 算 法 或 者 是 其 他 
图 像 算法 。 


7.3.3 飞行 控制 板 软件 系统 设计 


系统 总 体 软件 设计 如 图 7.3.2 所 示 。 


MPU9150 em R 
MPU9150 接口 = 姿态 解 算 一 一 | 稳定 
— R] 通信 e 混合 计算 


接口 


TM4C LIB 
From TI 


油门 控制 
接口 


数字 摄像 
头 接 口 


数字 摄像 头 c 


Poo 


图 7.3.2 飞行 控制 板 软件 系统 框图 


飞行 控制 板 软件 主要 分 为 3 个 层次 。 

1. 底层 接口 驱动 

利用 TI 官方 提供 的 底层 库 实现 对 基本 芯片 资源 的 调用 ,包括 基本 核心 配置 .YC 驱 
Z) SPI 驱动 .PWM 驱动 以 及 EEPROM 驱动 等 。 

利用 底层 驱动 实现 模块 化 的 具体 硬件 设备 的 功能 ,包括 MP9150 的 配置 以 及 数据 读 
取 、 电 子 调 速 器 的 配置 以 及 控制 等 。 

2. 功能 函数 库 

利用 标准 数学 函数 库 结合 芯片 的 浮 点 单元 以 及 Cortex-M4 的 并 行 运算 指令 优化 的 
ARM 数学 函数 库 以 及 姿态 解 算 、 坐 标 转换 需要 用 到 的 线性 代数 库 。 
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3. 功能 应 用 
调用 功能 函数 库 实 现 具体 的 算法 ,同时 通过 调用 硬件 接口 程序 实现 对 硬件 设备 的 安 
全 ,便捷 控制 。 


7.3.4 系统 板 软件 系统 设计 


1. ROS 操作 系统 

ROS(Robot Operating System) 是 一 个 机 器 人 软件 平台 , 它 能 为 异 质 计算 机 集群 提 
供 类 似 操 作 系统 的 功能 。ROS 的 前 身 是 斯 坦 福 人 工 智 能 实验 室 ,为 了 支持 斯 坦 福 智能 机 
器 人 STAIR 而 建立 的 交换 庭 (Switchyard) 项 目 。 其 分 布 式 .节点 化 的 程序 结构 为 系统 及 
程序 的 开发 维护 提供 了 极 大 的 便利 。 

ROS 最 大 的 特点 在 于 它 是 一 个 分 布 式 的 操作 系统 ,程序 模块 的 最 小 单元 为 节点 , 节 
点 运行 在 一 个 类 似 虚 拟 局 域 网 的 网 络 结构 中 ,节点 之 间 通 过 消息 .服务 以 及 行动 进行 数 
据 传 输 。 而 对 于 单个 节点 在 硬 、 软 件 上 可 以 完全 是 异 质 的 ,ROS 的 节点 可 以 使 用 C++、 
Python、Java Script、Octave 和 LISP 等 实现 ,可 以 在 大 多 数 基于 Linux 的 系统 上 运行 ,也 
可 以 在 Windows 下 运行 (如 大 多 数 桌面 系统 ,以 及 其 他 能 入 式 系统 安 卓 .OpenEmbedded/ 
Yocto 等 ) , 

2. SVO 

在 移动 机 器 人 领域 ,即时 建 图 与 定位 (SLAM) 以 及 路 径 记忆 与 追逐 被 认为 是 实现 其 
自主 导航 的 基础 ,而 自主 导航 又 是 实现 机 器 人 自主 运行 的 基础 。 

长 久 以 来 ,SLAM 算法 一 直 是 机 器 人 研究 的 重点 之 一 ,不 乏 众 多 成 熟 的 ,效果 出 色 的 
解决 方案 ,但 是 当 移动 机 器 人 从 地 面 机 器 人 转向 空间 飞行 器 时 ,机 器 人 的 自由 度 一 下 子 
从 3 个 增加 为 了 4 个 ,而 飞行 又 对 处 理 器 的 功 耗 、 体 积 有 着 较 高 的 限制 ,计算 性 能 有 限 ， 
由 此 SLAM 的 难度 一 下 子 剧 增 。 

因此 要 实现 空间 飞行 器 的 SLAM 算法 需 解决 两 个 问题 : 简单 实现 三 维 立体 视觉 的 
传感器 或 者 方法 ; 高 效 的 运动 估计 以 及 建 图 方法 。 

视觉 里 程 计 (VO) 即 是 为 解决 这 一 问题 出 现 的 产物 ,通常 的 视觉 里 程 计 都 是 简单 使 
用 图 像 特 征 点 来 匹配 ,而 文献 [7] 提 到 的 半 直 接 视 觉 里 程 计 (SVO) 方 法 则 是 一 种 结合 了 
之 前 广泛 用 于 激光 扫描 仪 的 直接 匹配 法 的 方案 。 

本 系统 使 用 SVO 方案 作为 视觉 定位 于 运动 预测 方案 。 
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3. 特征 集 树 与 特征 集 加 入 

特征 集 树 是 一 种 用 来 表示 特征 集 对 应 的 空间 数据 集 间 的 空间 关系 的 一 个 数据 结构 ， 
用 以 表示 哪 几 个 数据 点 集 在 空间 上 是 相 邻 的 。 特 征集 树 为 一 棵 多 叉 树 ,其 建立 的 过 程 如 
图 7.3.3 至 图 7.3.5 所 示 。 


图 7.3.3 平台 空间 移动 示意 图 


WW 


图 7.3.4 特征 集 树 建立 过 程 


曲线 表示 移动 平台 走 过 的 路 径 , 每 移动 一 小 段 距离 后 对 环境 做 一 次 观察 ,两 次 观察 
的 距离 必须 保证 前 后 两 次 的 观察 数据 存在 一 部 分 重合 。 图 中 的 圆圈 则 表示 各 次 观察 的 
范围 。 

图 7.3.4 中 每 个 节点 的 第 一 级 子 节点 是 与 其 直接 相关 的 ( 即 存在 重生 部 分 的 特征 
集 ) ,第 二 集 及 其 下 的 子 节点 虽 与 当前 节点 无 关 , 但 其 空间 位 置 是 与 当前 节点 位 置 最 近 ， 
因此 稍 后 加 入 的 特征 集 与 那些 节点 代表 的 特征 集 相 关 的 概率 非常 大 。 且 可 以 认为 越 接 
近 根 节点 概率 越 大 。 
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空间 特征 点 集 一 “| 遍历 匹配 I ———] 遍历 匹配 


特征 加 入 


特征 树 (| 


图 7.3.5 特征 加 入 过 程 框图 


每 当 有 新 的 特征 集 加 入 ,算法 将 从 特征 树 的 根 节点 出 发 , 沿 树 按 深度 顺序 进行 遍历 
匹配 ,通过 匹配 度 判断 是 否 是 直接 相关 ,并 将 与 其 直接 相关 的 特征 点 集 作 为 加 入 节点 的 
子 节点 。 在 匹配 的 过 程 中 将 需要 加 入 的 特征 集 分 为 已 匹配 与 未 匹配 两 部 分 ,将 匹配 部 分 
的 特征 点 获取 的 坐标 系 旋转 矩阵 对 为 匹配 的 特征 数据 进行 标记 ,再 将 未 匹配 部 分 的 特征 
集 作为 加 入 的 特征 存在 树 的 根 节点 。 当 然 为 了 控制 算法 复杂 度 , 必 须 限制 遍历 的 深度 ， 
遍历 深度 越 深 越 能 够 详细 反映 特征 点 集 间 的 相互 关系 ,当然 也 会 导致 算法 复杂 度 的 
提升 。 


7.3.5 总 结 与 展望 


本 课题 涵盖 了 机 械 、 控 制 \ 机 器 视觉 .机 器 人 学 .分布 式 计算 、 骨 和 人 式 Linux RA dik 
入 式 MCU .传感器 数据 融合 数据 滤波 等 各 方面 的 知识 与 技术 。 覆 盖 面 非常 广 ,难度 非 
常 高 ,课题 可 以 说 是 对 实现 四 旋翼 飞行 器 的 完全 自主 飞行 进行 了 一 次 尝试 。 

课题 实施 的 过 程 获得 了 一 些 不 错 的 成 果 , 基 本 实现 了 四 旋翼 飞行 器 的 路 径 跟 随 功 
能 ,基本 程度 上 实现 了 四 旋翼 飞 行 器 的 SLAM 算法 ,当然 距离 实现 完善 的 自主 飞行 任务 
还 有 相当 长 的 距离 。 

虽然 目前 来 看 地 面 自主 移动 机 器 人 还 不 完美 , 现 阶 段 研 究 飞行 器 的 自主 导航 似乎 有 
一 些 “ 还 没 学 会 走路 就 想 着 飞 的 "意味 ,但 作者 认为 脚踏实地 并 不 意味 着 不 能 仰望 星空 ， 
四 旋翼 飞行 器 的 发 展 虽然 存在 重重 阻力 ,不 少 人 还 对 其 可 能 的 应 用 产生 了 担忧 ,但 其 前 
景 以 及 应 用 价值 是 无 限 的 。 
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7.4 上 毕业 设计 作品 2 
四 旋翼 飞行 器 


基于 Kinect 的 穿 窗 和 手势 控制 


7.4.1 课题 概述 


Kinect 是 一 种 3D 体感 摄像 机 ,与 普通 摄像 机 相 比 ,可 以 感知 距离 信息 ,在 机 器 视觉 
邻 域 中 有 许多 有 价值 的 应 用 。 本 课题 重点 在 于 利用 Kinect 作为 传 感 设备 实现 四 旋 愤 飞 
行 器 的 自控 飞行 ,通过 Kinect 获取 飞行 器 的 移动 状态 以 及 深度 数据 ,PC 作为 基站 部 分 完 
成 图 像 处 理 以 及 路 径 计算 ,对 四 旋 淆 飞行 器 发 送 控制 命令 ,实现 对 飞行 器 的 跟踪 定位 ,并 
且 控 制 飞行 器 完成 钻 窗 以 及 手势 识别 控制 的 动作 。 


7.4.2 硬件 系统 概述 


整个 系统 硬件 由 两 大 部 分 组 成 ,分 别 是 基站 部 分 以 及 飞行 器 部 分 ,如 图 7. 4.1 所 示 。 
以 下 介绍 主要 部 分 。 


也 面 控制 
PC Kinect 
飞行 器 
E NRF 无 线 模块 NRF 无 线 模块 
地 面 控制 板 (地 面 站 ) D| um 
飞 控 


图 7.4.1 硬件 结构 图 


1. 地 面 控制 板 

QD 实现 与 PC 上 位 机 之 间 的 交互 通信 。 通 过 上 位 机 可 以 设置 四 轴 的 各 项 参数 ,观测 
飞行 器 的 实时 状态 。 

@ 实现 飞行 控制 板 之 间 的 交互 通信 ,包括 传送 遥控 数据 和 控制 命令 数据 ,接收 飞行 
器 的 状态 数据 。 
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O 完成 实时 遥控 器 数据 的 采集 。 采 集 遥 控 器 的 PPM 信号 并 解析 成 真正 的 遥控 数 
据 , 实 现 遥 控 器 对 四 旋翼 飞行 器 的 控制 。 

2. PC 上 位 机 

PC 上 位 机 的 功能 描述 如 图 7. 4. 2 所 示 。 


一 一 | PID 控 制 


向 飞行 器 发 


送 指令 
接收 飞行 器 
的 反馈 信息 
(1) 获取 Kinect 彩 色 图 像 数据 并 显 计算 飞行 器 
示 目标 


(2) 获取 Kinect 深 度数 所 


(3) 对 Kinect 深 度数 据 进行 处 理 得 7 
到 Kinect 视 角 中 所 有 物体 的 位 置信 [ ^| 路 径 规划 
息 S H 

(4) 将 得 到 的 深度 数据 进行 计算 机 控制 飞行 
可 视 化 处 理 并 显示 “| 向 目标 前 


(5) 获取 Kinect 骨 骼 数据 
(6) 对 骨骼 数据 进行 处 理 得 到 头 、 
双手 、 双 肩 以 及 消 椎 的 位 置信 息 


接收 飞行 器 
的 反馈 信息 


判断 操作 者 
的 姿势 


根据 姿势 向 
手势 控制 H tmd 
相关 指令 


接收 飞行 器 
的 反馈 信息 


图 7.4.2 上 位 机 功能 描述 


3. 飞行 控制 板 

飞行 控制 板 的 主要 功能 包括 以 下 几 个 。 

中 飞行 器 传感器 数据 采集 及 处 理 , 包 括 六 轴 传 感 器 的 姿态 数据 、 超 声波 模块 测量 到 
的 高 度数 据 、 光 流传 感 器 的 位 移 数据 。 

© 通过 电机 驱动 程序 修改 飞行 控制 板 输 出 四 路 PWM 波 的 占 空 比 ,调节 4 个 电机 的 
转速 来 实现 对 四 旋翼 飞行 器 运动 状态 的 控制 。 


S 
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© 与 地 面 控制 板 的 交互 通信 ,接收 地 面 控 制 站 发 送 来 的 遥控 器 数据 以 及 其 他 控制 命 
令 , 同 时 向 地 面 站 反馈 自身 各 项 状态 数据 。 

4. Kinect 深度 摄像 头 

深度 数据 是 Kinect 的 精髓 ,Kinect 通过 发 射 近 红外 线 光 源 来 获得 深度 图 ,只 要 有 大 
字形 的 物体 ,Kinect 都 会 去 追踪 ,即便 不 开 灯 ,Kinect 也 会 去 追踪 ,Kinect 有 发 射 fil d 
计算 视觉 重 现 的 类 似 过 程 。 它 的 “深度 眼睛 ”是 有 红外 投影 机 和 红外 摄像 头 组 合 而 成 的 ， 


投影 和 接收 互 为 重生 。 
本 课题 中 ,利用 深度 数据 ,探测 无 人 机 的 位 置 ,帮助 无 人 机 稳定 飞行 以 及 完成 特定 
动作 。 


在 Kinect Hi M ,通过 20 个 关节 点 来 表示 一 个 骨架 ,具体 如 图 7. 4. 3 所 示 。 当 走 进 
Kinect 的 视野 范围 时 ,Kinect 就 可 以 把 你 的 20 个 关节 点 的 位 置 找到 (当然 你 得 站 着 ) ,位 
置 通过 (z，y， zx) 坐 标 来 表示 。 


肩膀 中 心 


右 肩膀 左肩 膀 


a Bap 


TR JchWR 


左 脚 
图 7.4.3 Kinect 视野 中 的 骨骼 图 


通过 骨架 数据 ,利用 Kinect 提供 的 函数 ,可 以 识别 人 的 特定 动作 ,是 手势 控制 无 人 机 
的 基础 ,在 后 文中 将 详细 介绍 。 
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7.4.3 目标 物体 定位 和 追踪 


1. 物体 的 识别 与 追踪 

想 要 实现 对 四 旋 淆 飞行 器 的 控制 ,完成 一 系列 的 动作 ,首先 要 “看 "到 四 旋 淆 飞行 器 
以 及 Kinect 视角 中 其 他 物体 的 位 置 , 即 定位 ,以 保证 飞行 器 在 飞行 过 程 中 不 会 撞 到 障碍 
物 , 并 且 可 以 成 功 地 控制 四 旋 避 飞行 器 完成 特定 的 任务 。 

D 四 旋 潍 飞行 器 的 识别 及 追踪 

在 对 四 旋 导 飞行 器 进行 定位 时 ,把 在 高 度 阔 值 内 的 物体 判断 为 四 旋 避 飞行 器 ,然后 
对 其 进行 控制 。 计 算得 到 飞行 器 位 置信 息 的 程序 如 下 : 

for (int il6 = 0, i32 = 0; i16 < depthFrame. Length && i32 < depthFrame32.Length; i16++, i32 

+= 4) 


{ 
if ((realDepth 2100) && (realDepth < 2450))// 飞 机 


{ 
depthFrame32[i32 + GreenIndex] = 255; 
flyXSum += il6 % 640; 
flyYSum += il6 / 640; 
flyDSum += realDepth; 
countFly++; 


} 


程序 中 flyXSum+ = i16%640; flyYSum += i16/640 语句 是 为 了 把 线性 数据 转换 
成 X.Y 坐 标 系 下 的 坐标 ,以 便于 之 后 对 四 旋翼 飞行 器 的 位 置 进行 更 加 直观 地 标定 及 
控制 。 

由 于 从 Kinect 得 到 的 数据 是 以 像素 形式 出 现 的 ,所 以 在 判断 时 是 对 逐个 点 进行 判断 
的 ,但 是 由 于 最 终 需 要 得 到 的 数据 是 四 旋涡 飞行 器 的 具体 位 置 ,而 根据 高 度 阔 值 所 判断 
得 到 的 点 是 四 轴 飞 行 器 在 图 像 中 所 有 的 像素 点 ,所 以 要 对 这 些 像 素 点 的 高 度 、 当 前 高 度 
下 的 X 坐标 和 YY 坐标 做 平均 ,从 而 确定 四 旋 细 飞行 器 的 位 置 ,由 于 四 旋 沟 飞行 器 所 对 应 
的 图 像 中 的 像素 点 的 高 度 大 致 是 在 同一 平面 上 的 ,所 以 这 里 不 考虑 由 于 摄像 头 成 像 原理 
所 造成 的 误差 。 

countFly 变量 表示 的 是 被 判定 为 飞机 的 像素 点 的 个 数 ,作为 之 后 计算 当前 高 度 下 的 
X 坐标 和 了 坐标 的 均值 时 的 除数 。 
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if (countFly > 50) 

4 
flyXAverage - (int)flyXSum / countFly; 
flyYAverage - (int)flyYSum / countFly; 
flyDAverage - (int)flyDSum / countFly; 


) 


在 计算 完 均 值 之 后 就 可 以 得 到 四 旋 避 飞行 器 的 当前 位 置信 息 。 

2) Kinect 视角 中 其 他 物体 的 识别 

在 控制 飞机 自主 钻 窗 应 用 中 ,可 能 在 Kinect 视角 中 出 现 的 东西 有 四 旋翼 飞行 器 、 窗 
以 及 人 ,而 此 时 只 要 一 开始 通过 Kinect 标定 窗 高 ,就 可 以 很 容易 地 从 得 到 的 深度 数据 中 
分 辨 出 窗 TUNERE KITARA o 

由 窗 高 做 分 割 线 ,将 和 窗 高 高 度 相差 不 大 的 像素 点 识别 为 窗 ,然后 就 能 根据 均值 算 
法 计算 出 窗 在 Kinect 深度 图 像 中 的 位 置 。 同 时 得 知 窗 的 高 度 后 ,控制 飞机 高 度 在 地 面 到 
窗 之 间 ( 地 面 离 Kinect 平面 的 距离 由 人 场 时 进行 一 次 标定 ) ,然后 就 可 以 定位 出 飞机 位 
置 。 最 后 还 需要 判断 的 就 是 在 Kinect 视角 中 是 否 有 人 存在 ,以 便 在 窗 的 位 置 改变 后 可 以 
控制 飞机 进行 下 一 次 的 运动 。 由 于 开始 已 经 标定 过 窗 高 ,认为 人 的 最 高 点 是 一 定 会 高 于 
窗户 的 ,所 以 就 将 Kinect 视角 中 高 于 窗户 的 像素 点 判定 为 人 。 


if (realDepth < 2000)// 窗 户 

{ 
depthFrame32[i32 + RedIndex] = 255; 
windowXSum += il6 % 640; 
windowYSum += il6 / 640; 
countWindow++ ; 

) 

if ((realDepth > 2100) && (realDepth < 2450) ) // VUE RE & £538 

1 
depthFrame32[i32 + GreenIndex] = 255; 
flyXSum += i16 % 640; 
flyYSum += i16 / 640; 
countFly**; 

j 

if (realDepth < 1500) // A. 

{ 
depthFrame32[ i32 + GreenIndex] = 255; 
depthFrame32[i32 + RedIndex] = 255; 
countPeople++ ; 
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同样 地 ,在 得 到 这 些 像素 点 后 ,会 通过 计算 均值 的 方法 求 出 可 以 使 用 的 物体 的 具 
体位 置 , 在 得 到 这 些 有 效 位 置 之 后 再 进行 路 径 规 划 以 及 控制 四 旋 辟 飞行 器 飞行 等 
动作 。 

2. 四 旋翼 飞行 器 的 定 高 及 定位 

在 识别 出 四 旋 导 飞行 器 的 位 置 之 后 , 便 可 以 利用 上 位 机 和 四 旋 副 飞行 器 通信 ,个 人 
对 其 进行 控制 ,保证 四 旋翼 飞行 器 的 平稳 飞行 以 及 实现 四 旋 攻 飞行 器 的 定 高 及 定位 。 

由 于 Kinect 在 采集 数据 时 精度 不 够 以 及 噪声 干扰 ,所 以 对 四 轴 飞 行 器 识别 时 会 存在 
强烈 的 抖动 ,于 是 就 要 对 得 到 的 数据 进行 消 抖 处 理 。 

首先 ,把 当前 帧 得 到 的 四 旋 沟 飞行 器 的 位 置信 息 和 上 一 帧 进行 比较 ,x、y、d 分 开 比 
较 , 如 果 zy 的 差距 不 超过 15 像素 ,d 的 差距 不 超过 20mm, 就 判定 四 旋 导 飞行 器 在 两 帧 
间隔 的 这 段 时 间 内 没有 发 生 位 置 的 改变 ,这 里 以 深度 这 一 维度 为 例 : 

if ((flyDAverage > flyDaverage lastframe - 20) && (flyDAverage < flyDaverage_lastframe + 


20)) 


( 
flyDAverage - flyDaverage lastframe; 


} 
else if (flyDAverage <= flyDaverage lastframe - 20) 


f 
flyDAverage = flyDAverage + 19; 
) 
else if (flyDAverage »- flyDAverage * 20) 
1 
flyDAverage - flyDAverage - 19; 
i 
Jug. H ipi C3 E 8 PUES V Cre (E EE AN E — LEE EZ Je A PUR 2E SEE BERE RO TS 
那么 就 认为 四 旋涡 飞行 器 的 位 置 发 生 了 变化 。 同 样 , 以 深度 为 例 , 无 论 是 高 了 20mm 或 
是 低 了 20mm, 飞 机 当前 位 置信 息 都 会 被 重新 计算 ,但 是 不 会 直接 就 将 当前 所 得 到 的 飞机 
位 置信 息 作为 最 终结 果 ,因为 这 样 做 会 产生 跳 变 。 程 序 的 做 法 是 将 上 一 帧 得 到 的 飞机 
位 置 的 点 看 作 长 方 体 盒子 的 中 心 , 在 当前 帧 得 到 的 数据 超出 盒子 的 范围 之 后 ,就 会 扒 
动 盒子 向 当前 帧 所 得 数据 的 方向 移动 , 当 新 盒子 的 边缘 碰 到 当前 帧 所 得 四 旋 惧 飞行 器 
的 位 置 时 便 停止 移动 ,将 新 盒子 的 中 心 坐标 判定 为 四 旋 愤 飞行 器 当前 所 在 的 位 置 
坐标 。 
由 于 得 到 的 四 旋翼 飞行 器 的 位 置 坐标 所 处 的 坐标 系 是 深度 坐标 系 , 即 d 代表 深度 ,x 
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A y 分 别 代表 得 到 图 像 的 像素 值 而 非 真 实 的 三 维 坐标 中 的 x A y 坐标 ,所 以 这 个 坐标 系 
并 不 是 日 常 所 熟悉 的 三 维 坐标 系 , 所 以 需要 将 坐标 系 进行 转换 。 在 具体 实现 过 程 中 ,对 
Kinect 所 得 到 的 对 应 深度 的 图 像 进行 标定 ,然后 根据 原理 推导 出 相应 的 转换 公式 ,得 到 
的 坐标 与 实际 测量 值 之 间 的 误差 不 大 ,可 以 忽略 。 

在 成 功 地 对 四 旋翼 飞行 器 进行 识别 以 及 追踪 之 后 ,就 需要 利用 控制 原理 对 四 旋 必 飞 
行 器 进行 控制 了 。 

设 定好 了 目标 高 度 和 目标 位 置 ,测量 目标 值 与 实际 值 的 误差 ,通过 上 位 机 和 下 位 机 
之 间 的 通信 不 断 地 控制 调整 4 个 螺旋 桨 的 转速 ,使 目标 值 与 实际 值 之 间 的 误差 不 断 减 
小 ,使 实际 值 达到 目标 值 。 整 个 系统 是 一 个 反馈 控制 系统 ,为 了 避免 复杂 的 精确 动力 学 
建 模 ,在 这 里 选用 PID 控制 器 , 定 高 流程 框图 如 图 7. 4.4 所 示 。 


获取 飞行 器 高 度 


与 目标 高 度 差 


计算 飞行 器 
当前 速度 


Y 
iP. I.D 
控制 量 


Y 
Output=P+I+D 


i 
向 飞行 器 发 送 
Output 


图 7.4.4 定 高 流程 框图 


由 于 对 3 个 轴 的 控制 相对 独立 且 控制 思路 与 方法 也 相差 不 大 ,所 以 以 定 高 为 例 进 行 
WR. 

高 度数 据 已 经 通过 Kinect 得 到 ,所 以 需要 做 的 就 是 对 四 轴 飞 行 器 进行 PID 控制 ,这 
里 直接 控制 的 量 是 四 旋 沟 飞行 器 的 油门 ,所 得 到 的 数据 是 飞行 器 的 位 置 ,需要 飞行 器 到 
达 想 要 控制 的 目标 高 度 ,其 中 比例 项 P 是 飞行 器 目标 位 置 与 当前 位 置 的 差 ,积分 项 I 是 飞 
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行 器 目标 位 置 与 每 一 帧 所 得 的 位 置 差 的 累积 ,微分 项 D 就 是 飞行 器 的 速度 , 即 当 前 帧 位 
置 与 上 一 帧 位 置 的 差 。 

3. Kinect 视角 中 物体 的 位 置 关系 转换 

由 于 从 Kinect 上 所 获取 到 的 深度 数据 是 像素 点 所 在 的 那个 和 Kinect 所 在 平面 平行 
的 平面 和 Kinect 所 在 平面 之 间 的 距离 ,以 及 摄像 头 本 身 的 成 像 原 理 等 原因 会 造成 得 到 的 
像素 点 在 当前 平面 上 的 zx、y 坐标 并 不 是 其 在 整个 三 维 直角 坐标 系 中 的 zx 、y 分 量 呆 ,于 是 
就 造成 了 一 个 问题 : 如 果 直 接 用 得 到 的 像素 点 所 在 平面 的 x、y 分 量 计算 两 个 不 同 高 度 
的 物体 的 水 平 距离 , 即 利用 公式 D? — (zi 一 z+;)? 十 (yi 一 ys)* 所 得 到 的 距离 并 不 是 实际 的 
两 个 物体 之 间 的 水 平 距离 。 

图 7.4.5 所 示 的 斜 线 kC 上 的 所 有 点 映射 到 Kinect 的 传感器 上 只 是 一 个 点 而 已 ,也 
就 是 说 ,如 果 在 地 面 上 放 着 两 个 不 同 高 度 的 物体 ,它们 的 顶点 恰好 在 这 条 斜 线 上 ,那么 按 
照 之 前 的 距离 计算 方法 得 到 的 这 两 个 物体 的 水 平 距离 就 是 零 , 显 然 这 个 结果 是 错误 的 。 

o 参考 平面 


目标 平面 


X 
C( 红 外 相机 ) 


二 激光 投影 仪 ) 


图 7.4.5 摄像 头 成 像 示意 图 


想 要 得 到 正确 的 水 平 距离 就 必须 将 Kinect 得 到 的 深度 数据 坐标 转换 成 三 维 直 角 坐 
标 系 下 的 坐标 ,然后 再 利用 公式 D? S= Gri a)? H On — 0? 计算 出 两 个 物体 的 水 平 距 
离 , 此 时 这 个 水 平 距离 才 是 实际 的 水 平 距离 。 

这 个 坐标 转换 的 公式 可 以 通过 相似 三 角形 的 比例 规律 得 出 ,这 里 不 作 详 述 。 

这 个 问题 的 另 一 个 解决 方案 就 是 利用 微软 所 提供 的 Kinect for Windows SDK 中 的 
转换 类 。 
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7.4.4 路 径 规 划 及 控制 


1. 自主 钻 窗 

图 7. 4. 6 所 示 , 此 应 用 要 实现 的 是 通过 Kinect 识别 出 四 旋 恤 飞行 器 以 及 窗户 的 位 置 
后 ,通过 PC 进行 路 径 规 划 , 然 后 向 四 旋翼 飞行 器 发 出 控制 指令 实现 四 旋 尼 飞行 器 的 钻 窗 
功能 ,同时 在 窗户 位 置 发 生 改 变 后 ,通过 Kinect 的 观察 ,可 以 实现 对 窗户 的 再 次 定位 以 及 
通过 PC 控制 四 旋翼 飞行 器 再 次 完成 钻 窗 的 动作 。 


开始 
! 
1 FI CBAR 
发 送 解锁 定位 指令 id 
SO ef tms 
zn 第 二 目标 点 ? 
Y 是 
WES DU | 
第 二 目标 点 
控制 飞行 器 降落 并 
锁定 
1 
控制 飞行 器 前 往 第 
一 目标 点 


图 7.4.6 上 位 机 软件 流程 框图 
1) 一 些 状态 变量 的 设置 及 作用 
在 对 四 旋 愤 飞行 器 以 及 窗户 进行 定位 时 ,四 旋翼 飞行 器 当前 的 状态 .人 进入 的 情况 、 
是 否 完成 钻 窗 都 需要 利用 一 些 状态 变量 来 记录 。 
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bool startFindWin = false; // 开 始 寻找 窗户 

bool emegStop = false; // 紧 急 停机 

bool isFlying = false; // 表 示 飞 机 正在 飞行 

bool theFirstTimeCalprePos = false; // 为 了 保证 计算 prePos 位 置 只 做 一 次 
bool getToPrePos = false; // 是 否 到 达 第 一 个 目标 位 置 

bool getToPrePossymmetry = false; // 是 否 到 达 目 标 最 终 位 置 

bool isPosCtrl = false; // 表 明 已 经 开始 定位 

bool isPeopleIn = false; // 是 否 有 人 进入 Kinect 视角 中 


设 定 这 些 标志 位 之 后 ,程序 就 可 以 根据 相应 的 标志 位 状态 来 判断 是 否 要 做 接 下 去 的 
操作 。 例 如 , 当 有 人 进入 Kinect 视角 时 就 会 控制 四 旋 避 飞行 器 不 做 动作 ,只 有 等 人 出 去 
之 后 , 才 继 续 对 四 旋 滤 飞行 器 发 送 指令 ,完成 相应 任务 。 

所 用 到 的 标志 位 在 后 面 内 容 中 会 详细 阐述 其 作用 。 

2) 窗户 方向 的 识别 

7.4.3 节 中 已 经 介绍 了 如 何 对 Kinect 视角 中 的 物体 进行 定位 ,但 是 由 于 四 旋 愤 飞行 
器 钻 窗 这 一 举动 需要 从 窗 的 一 侧 穿 过 到 达 另 一 侧 , 所 以 还 需要 做 的 就 是 判断 窗户 的 朝向 
(本 课题 中 的 方法 仅 限于 判断 窗户 是 和 Kinect 平行 还 是 与 Kinect 垂直 )。 

为 了 解决 这 个 问题 ,本 程序 采取 的 方法 是 在 窗 顶 一 边 放置 一 个 标志 物 ( 下 文中 简称 
“小 旗 ”) ,通过 窗户 位 置 以 及 小 旗 的 位 置 , 可 以 得 到 和 窗户 平行 的 向 量 (这 里 不 考虑 = 轴 ， 
仅 讨论 和 地 面 平行 的 二 维 平面 ) ,得 到 这 个 向 量 后 ,窗户 的 朝向 就 能 很 方便 地 被 确定 ; 


deltaX = flagXAverage - windowXAverage; 
deltaY - windowYAverage - flagYAverage; 


根据 deltaX deltaY 就 可 以 计算 出 窗户 的 朝向 ,从 理论 上 来 说 ,如 果 deltaX —0 ,就 说 
明 窗户 是 和 y 轴 平 行 的 , 即 窗 户 的 朝向 与 x 轴 平 行 ; 同 理 ,deltaY 二 0, 说 明 窗户 是 和 x 轴 
平行 的 , 即 窗户 的 朝向 与 y 轴 平 行 。 

在 得 到 窗户 的 朝向 之 后 ,就 需要 进一步 确定 四 周 飞行 
器 的 目标 位 置 ,在 本 程序 中 ,把 四 旋 辟 飞 行 器 的 目标 分 成 两 e R | 
个 , 即 窗户 前 的 一 点 和 窗户 后 的 一 点 ,如 图 7.4.7 所 示 。 

在 图 7.4.7 中 ,1 号 点 代表 四 放浪 飞行 器 ,2 ANB WL, WENERA 
户 前 的 一 点 ( 即 在 四 旋翼 飞行 器 这 一 侧 的 目标 点 ),3 号 点 目标 位 置 示意 图 
即 窗户 后 的 点 ( 即 在 四 旋 汉 飞行 器 另 一 侧 的 目标 点 ) ,也 是 
四 旋 沟 飞行 器 最 终 的 目标 点 。 
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在 程序 中 表现 为 对 deltaX 和 deltaY 的 判断 : 


if (deltaX < 35 && deltaX > - 35)//NS, 由 窗户 的 矢量 方向 算出 
t 

prePosX = (flyXAverage -  windowXAverage > = 0) ? (windowXAverage + 100) : 
(windowXAverage - 100); 

prePosY - windowYAverage; 

prePossymmetryX - (flyXAverage - windowXAverage » - 0) ? (windowXAverage - 100) : 
(windowXAverage * 100); 

prePossymmetryY - windowYAverage; 

dirWinS2N - true; 

dirWinE2W - false; 
) 
else if (deltaY < 35 && deltaY > - 35)//EW 
{ 

prePosX = windowXAverage - 20; 

prePosY = (flyYAverage - windowYAverage > = 0) ? (windowYAverage + 100) : 
(windowYAverage — 100); 

prePossymmetryX = windowXAverage - 20; 

prePossymmetryY - (flyYAverage - windowYAverage » - 0) ? (windowYAverage - 100) : 
(windowYAverage * 100); 

dirWinS2N - false; 

dirWinE2W - true; 
) 


在 这 段 代 码 中 , prePosX 和 prePosY 代表 第 一 目标 点 , prePossymmetryX. 和 
prePossymmetryY 代表 第 二 目标 点 ,也 是 最 终 目 标点 的 m. y 值 。dirWinS2N 和 
dirWinE2W 分 别 表示 对 窗户 朝向 的 判断 结果 。 

在 识别 出 四 旋 愤 飞行 器 的 位 置 以 及 窗户 的 位 置 并 且 判 断 出 窗户 的 朝向 之 后 ,就 要 进 
行 具 体 的 对 四 旋 恤 飞行 器 的 路 径 规划 。 

为 了 保证 四 旋 演 飞行 器 在 钻 窗 的 过 程 中 不 碰 到 窗户 的 i 
左 \ 右 两 侧 , 程 序 首先 会 控制 四 旋涡 飞行 器 到 达 和 窗户 同一 e 
直线 上 的 点 ,然后 再 控制 四 旋涡 飞行 器 向 前 飞 至 目标 1 点 ， 
在 确定 判断 出 四 旋翼 飞行 器 到 达 目 标 1 点 后 ,控制 四 旋涡 
飞行 器 向 前 穿 过 窗户 ,到 达 所 识别 出 的 最 终 目标 点 ,其 过 程 
如 图 7.4.8 所 示 。 


图 7.4.8 四 旋翼 飞行 器 飞行 
路 径 示意 图 
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3) 飞行 方向 及 距离 控制 

在 识别 出 四 旋翼 飞行 器 位 置 、 窗 户 位 置 以 及 规划 出 简单 的 路 线 之 后 ,所 要 做 的 就 是 对 
四 旋翼 飞行 器 进行 控制 ,使 其 能 按照 所 规划 的 路 径 运 动 ,最终 到 达 目 标 位 置 ,实现 钻 窗 动作 。 

由 于 Kinect 摄像 头 以 及 其 他 原因 会 导致 数据 中 存在 一 些 噪声 ,从 而 会 导致 在 四 旋翼 
飞行 器 定位 时 ,即使 飞行 器 稳定 地 停 在 一 个 点 上 ,也 会 被 判定 为 在 这 个 点 周围 晃动 ,所 以 
在 对 四 旋 副 飞行 器 是 否 到 达 指 定 目标 点 的 判断 中 ,程序 留 出 了 误差 的 容 限 值 ,认为 四 旋 
翼 飞 行 器 定位 在 以 目标 点 为 中 心 的 边 长 为 25mm 的 方块 内 都 判断 为 到 达 目 标 。 

控制 流程 图 如 图 7. 4.9 所 示 。 


deltaFlyX2pre = flyXAverage - prePosX; 
deltaFlyY2pre - flyYAverage - prePosY; 
deltaFlyX2sym - flyXAverage - prePossymmetryX; 
deltaFlyY2sym - flyYAverage - prePossymmetryY; 


其 中 deltaFlyX2pre 和 deltaFlyY2pre 是 四 旋翼 飞行 器 与 第 一 目标 点 的 X 轴 与 Y 轴 
方向 上 的 距离 ,deltaFlyX2sym 和 deltaFlyY2sym 是 四 旋翼 飞行 器 与 最 终 目标 点 的 X 轴 
与 立轴 方向 上 的 距离 。 

在 得 到 这 些 变量 后 ,下 面 一 步 就 可 以 对 四 旋 疆 飞行 器 进行 具体 位 移 量 的 控制 了 。 在 
进行 位 移 控制 时 ,要 做 的 就 是 控制 飞行 器 到 达 之 前 所 判断 出 的 目标 点 ,首先 ,控制 飞行 器 
在 X 方 向 上 到 达 目 标点 的 z 坐标 ,然后 再 控制 飞行 器 在 Y 方向 上 到 达 目 标点 的 y 坐标 ， 
最 后 对 得 到 的 飞行 器 位 置 进行 判断 ,判断 出 飞行 器 是 否 到 达 目 标点 , 巾 于 噪声 以 及 飞行 
器 本 身 的 微小 误差 ,所 以 目标 点 并 不 是 单纯 的 一 个 点 ,而 是 那个 点 所 辆 射出 的 一 个 正方 
形 区 域 ,只 要 飞行 器 到 达 这 个 区 域内 ,就 认为 飞行 器 到 达 了 目标 。 


if (dirWinE2W == true && dirWinS2N -- false && isFlying == false) 
1 
if (getToPrePos -- false) 
{ 
if (deltaFlyX2pre >= 25) 
{ 
if (deltaFlyX2pre >= 120) 
{ sp. Write(TxBufferFrameMovL60, 0, 32); } 
else if (deltaFlyX2pre »- 60) 
( sp. Write(TxBufferFrameMovL32, 0, 32); } 
else 
( sp. Write(TxBufferFrameMovL15, 0, 32); } 
) 
else if (deltaFlyX2pre <= - 25) 
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if (deltaFlyX2pre «- - 120) 
( sp. Write(TxBufferFrameMovR60, 0, 32); } 
else if (deltaFlyX2pre <= - 60) 
( sp. Write(TxBufferFrameMovR32, 0, 32); } 
else 
( sp. Write(TxBufferFrameMovR15, 0, 32); ] 
} 
else if (deltaFlyY2pre >= 25) 
{ 
if (deltaFlyY2pre >= 120) 
{ sp. Write(TxBufferFrameMovB60, 0, 32); } 
else if (deltaFlyY2pre >= 60) 
{ sp. Write(TxBufferFrameMovB32, 0, 32); } 
else 
{ sp. Write(TxBufferFrameMovB15, 0, 32); } 
} 
else if (deltaFlyY2pre <= 一 25) 
{ 
if (deltaFlyY2pre <= 一 120) 
{ sp. Write(TxBufferFrameMovF60, 0, 32); } 
else if (deltaFlyY2pre <= - 60) 
( sp. Write(TxBufferFrameMovF32, 0, 32); } 
else 
( sp. Write(TxBufferFrameMovF15, 0, 32); } 
) 
else 
{ 
getToPrePos = true; 
sp. Write(clearFlowData, 0, 32); 
} 
) 
if (getToPrePos -- true && getToPrePossymmetry -- false) 
f 


} 
} 


其 中 if (dirWinE2W == true && dirWinS2N == false && isFlying == false) 
3x p ift] E E ALS P 9 391 I8] DL DU EXE. € AT ARE t EEG E f o dE PT DA HIE BLAH 
其 进行 控制 , 若 值 是 false 则 说 明 没有 对 四 旋翼 飞行 器 在 进行 定位 ,可 以 由 上 位 机 对 其 进 
行 控制 。 

if (getToPrePos == false) 和 if (getToPrePos == true &-&- getToPrePossymmetry == 
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false) 是 在 判断 四 旋翼 飞行 器 是 否 到 达 第 一 个 目标 位 置 , 如 果 没 有 到 ,那么 首先 要 控制 飞 
行 器 到 达 第 一 个 目标 位 置 , 如 果 到 了 目标 位 置 1, 却 没有 到 达 最 终 目 标 , 则 由 上 位 机 继续 
对 飞行 器 进行 控制 ,使 其 到 达 最 终 的 目标 位 置 。 

在 if (getToPrePos == true & & getToPrePossymmetry == false) 后 所 省 略 的 内 
容 是 上 位 机 对 飞行 器 进行 位 移 控制 的 过 程 ,和 if (getToPrePos == false) 下 的 语句 作用 
类 似 。 

由 于 窗户 的 朝向 有 两 种 情况 ,所 以 需要 分 类 讨论 ,以 上 代码 只 完成 了 窗户 朝向 为 
dirWinE2W 的 情况 ,在 另 一 种 情况 下 (dirWinS2N), 上 位 机 对 飞行 器 的 控制 方法 与 其 类 
似 , 所 以 这 里 就 不 再 袭 述 。 

在 控制 四 旋 必 飞行 器 钻 窗 过 程 中 , 遇 到 的 主要 难题 有 以 下 3 个 。 

O 在 判断 窗 的 状态 时 会 遇 到 问题 , 即 窗口 朝向 的 问题 ,在 本 课题 中 ,窗口 朝向 可 以 有 
两 个 ,一 个 是 水 平 的 ,一 个 是 垂直 的 ,但 是 仅仅 靠 Kinect 所 读 取 到 的 有 关 窗 的 数据 很 难 判 
断 出 窗口 的 朝向 。 

© 由 于 四 旋翼 飞行 器 本 身 的 晃动 导致 对 飞行 器 是 否 到 达 目 标点 的 判断 造成 了 干扰 。 

C) 由 于 是 根据 高 度 来 判定 物体 位 置 的 ,所 以 当 有 人 进入 场景 中 时 ,就 会 造成 对 窗 以 
及 飞行 器 位 置 判 断 的 误差 ,所 以 对 人 是 否 在 画面 中 的 判断 也 是 不 可 缺少 的 。 

针对 这 3 个 问题 也 采取 了 一 些 相应 的 解决 方案 。 

CD 对 于 这 个 问题 ,采用 了 在 窗户 一 角 放 上 一 个 标志 物 ( 如 图 7. 4. 10 所 示 ) 的 方法 来 
解决 ,通过 判断 标志 物 和 窗 的 相对 位 置 便 能 很 好 地 判断 出 窗 的 朝向 。 


图 7.4.10 窗户 以 及 窗户 一 角 的 标志 物 
© 通过 “盒子 滤波 可 以 解决 飞行 器 晃动 的 问题 。 
© 通过 新 增加 标志 位 的 方法 来 对 是 否 有 人 在 画面 中 进行 判断 并 且 将 判断 结果 赋值 
给 标志 位 ,从 而 在 下 一 帧 中 可 以 得 到 人 进出 画面 的 数据 。 
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图 7.4. 11 是 钻 窗 程序 所 接收 到 Kinect 的 彩色 图 像 数据 以 及 深度 图 像 数据 ,并 对 其 
进行 计算 机 可 视 化 后 得 到 的 结果 ,如 图 7. 4. 11 所 示 。 


图 7.4.11 程序 中 所 识别 出 的 窗户 位 置 


2. 手势 控制 
此 应 用 主要 实现 的 功能 为 通过 操作 人 和 手 的 移动 来 控制 飞行 器 的 前 、 后 、 左 、 右 飞行 以 


及 起 飞 和 锁定 ,图 7. 4. 12 所 示 为 控制 示意 图 。 


地 面 站 
PC — 7| (uARTÉSPI) 


puy 


图 7.4.12 手势 控制 示意 图 


1) 手势 控制 流程 图 
图 7. 4. 13 所 示 为 手势 控制 流程 图 。 
2) 手势 识别 及 控制 


通过 Kinect 所 获取 的 骨骼 数据 ,可 以 得 到 人 的 每 个 关节 点 的 坐标 ,这 些 关 节点 中 需 
JC Tp fit 5 EX B9 AA 


要 用 到 的 有 头 、 左 右手 和 左右 肩 , 人 摆 出 相应 的 姿势 ,上 位 机 通过 判断 这 些 
置 来 判断 人 的 当前 姿势 。 
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飞行 器 起 飞 并 
定位 


控制 飞行 器 降落 P um) 


空 制 飞行 器 前 进 


飞行 器 后 退 


空 制 飞行 器 左 移 


空 制 飞行 器 右 移 


图 7.4.13 Kinect 手势 控制 流程 图 


对 飞行 器 的 控制 主要 分 为 3 个 部 分 , 即 控制 其 起 飞 、 降 落 以 及 前 后 左右 动作 。 通 过 
3 种 不 同类 型 的 姿势 来 实现 这 3 部 分 的 控制 。 
3) 起 飞 


startFlyGes = rightHand.Y > SPIne.Y && (rightshoulder.Z - rightHand.Z> 0.2); // 起 飞 


从 Kinect f Sin OU F A JA RR HERY DEEEH W , R BUG F A 
HEFE HL m B feh 9 27) VE RR FI r J RME A AE E P l UNESE KAT AE €. EOL AO DUE 
飞行 器 发 出 解锁 并 定位 起 飞 的 命令 。 

控制 飞行 器 的 前 后 左右 。 对 飞行 器 的 前 进 、 后 退 、 左 移 、 右 移 的 控制 是 根据 操作 者 的 


第 7 章 ”成 功 案例 > 175 


右手 位 移 来 实现 的 : 计算 机 会 识别 操作 者 右手 的 位 置 ,将 当前 帧 数据 和 上 一 帧 比较 ,如 果 
操作 者 的 手 向 前 移动 ,那么 就 会 对 飞行 器 发 出 前 进 的 命令 ,同样 ,操作 者 的 右手 在 其 他 几 
个 方向 上 的 位 移 也 会 反馈 给 计算 机 ,从 而 通过 计算 机 控制 飞行 器 做 出 相应 的 移动 。 

降落 : 


startLand = leftHand.Y > head. Y && rightHand. Y > head. Y 


对 飞行 器 降落 的 判断 是 根据 操作 者 的 左右 手 以 及 头 部 位 置 来 实现 的 , 当 操 作者 做 出 
左右 手 上 举 过 头 的 动作 时 ,计算 机 就 会 判断 操作 者 想 要 控制 飞行 器 降落 ,于 是 就 会 对 飞 
行 器 发 送 相应 的 指令 。 


7.4.5 总 结 与 展望 


1. 总 结 

本 课题 主要 完成 的 任务 如 下 。 

CD 通过 Kinect 获取 四 旋翼 飞行 器 的 移动 状态 以 及 深度 数据 ,并 对 其 进行 分 析 处 理 。 

© 通过 PC 进行 图 像 处 理 , 得 到 四 旋翼 飞行 器 以 及 目标 物体 的 位 置 , 计 算 四 旋翼 飞 
行 器 的 飞行 轨迹 ,并 且 对 其 进行 控制 。 

© 实现 对 四 旋 愤 飞行 器 的 实时 跟踪 及 定位 ,控制 飞行 器 飞行 。 

@ 控制 飞行 器 完成 寻 窗 、 钻 窗 表演 动作 。 

2. 展望 

CD 深度 摄像 头 。 随 着 机 器 视觉 变 得 越 来 越 重要 ,深度 摄像 头 的 出 现 使 得 能 在 这 一 领 
域 有 更 大 的 发 展 。 使 用 深度 摄像 头 可 以 做 许多 事情 。 深 度 摄 像 头 的 主要 应 用 有 三 维 人 
脸 识别 技术 。 随 着 计算 机 技术 和 模式 识别 技术 的 飞速 发 展 和 三 维 数据 采集 技术 不 断 成 
熟 , 近 20 年 三 维 人 脸 识别 研究 受到 学 术 界 越 来 越 多 的 关注 ,三 维 人 脸 识别 已 为 当前 模式 
识别 技术 和 生物 特征 识别 技术 的 研究 热点 。 三 维 人 脸 识 别 的 基本 流程 如 图 7. 4. 14 所 
示 。 三 维 人 脸 识 别 具 有 以 下 几 点 明显 优势 : 三 维 数据 中 包含 人 脸 的 深度 信息 ,从 图 像 
信息 量 上 就 更 加 丰富 ; @ 三 维 数据 在 三 维 空间 内 可 以 任意 旋转 变化 ,可 以 从 不 同 的 角度 
观察 三 维 物体 的 差异 ; @ 三 维 人 脸 识 别 主要 基于 面部 的 深度 信息 ,对 于 日 常 化妆 的 影响 
和 附带 金属 物品 等 影响 具有 一 定 的 健壮 性 。 

© 手势 提取 与 识别 。 手 势 识 别 是 一 种 人 机 交互 技术 ,以 人 手 部 的 动作 直接 控制 计算 
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输出 识别 结果 


图 7.4.14 三 维 人 脸 识别 基本 流程 


机 的 输入 ,与 传统 的 键盘 .鼠标 等 相 比 具有 自然 直观 .易于 学 习 等 优点 。 使 用 计算 机 视觉 
技术 进行 手势 采集 后 ,需要 对 获得 的 图 像 进行 手势 分 割 ,将 手势 从 图 像 中 分 离 出 来 。 手 
势 分 割 常 用 的 方法 主要 有 增加 限制 法 、 肤 色 检 测 法 等 。 其 中 增加 限制 法 通过 佩戴 有 颜色 
的 标志 物 或 使 用 固定 颜色 的 背景 等 对 采集 环境 进行 限制 ,从 而 通过 特殊 颜色 进行 手势 分 
割 。 这 种 方法 降低 了 手势 的 自由 性 ,但 在 采集 精确 度 上 有 较 大 优势 。 肤 色 检测 法 根据 肤 
色 在 颜色 空间 分 布 的 特点 将 图 像 转换 到 相应 的 颜色 空间 进行 阔 值 分 离 。 使 用 肤色 检测 
法 可 以 直接 从 图 像 中 分 离 出 肤色 的 区 域 ,但 目前 的 技术 主要 存在 以 下 问题 :容易 受到 复 
杂 背 景 和 复杂 光照 条 件 影响 ,不 能 与 脸 部 等 与 肤色 相近 的 位 置 重 到 ,不 能 穿戴 非 肤色 的 
手套 等 。 使 用 Kinect 作为 手势 采集 的 工具 ,将 深度 图 转换 为 三 维 点 云 ,利用 深度 信息 进 
行 手 势 提 取 和 识别 分 析 , 相 比 于 二 维 手 势 识别 有 更 多 的 优势 。 随 着 深度 摄像 头 越 来 越 便 
宜 , 其 优势 也 变 得 越 来 越 突出 了 。 

@ 四 旋涡 飞行 器 。 四 旋涡 飞行 器 现今 有 着 众多 的 研究 方向 和 应 用 领域 ,从 国内 外 研 
究 情 况 以 及 科技 发 展 动态 来 看 ,其 发 展 趋势 主要 有 以 下 几 个 。 

微型 化 。 通 过 减少 飞行 器 的 体积 和 重量 ,减少 能 源 消耗 ,从 而 提高 飞行 器 的 飞行 时 
间 和 飞行 灵活 度 。 
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智能 化 。 随 着 计算 机 技术 的 迅速 发 展 ,可 以 提高 飞行 器 的 自 适应 能 力 和 自主 飞行 的 
能 力 ,使 其 能 够 自动 执行 更 多 更 复杂 的 任务 。 

多 功能 性 。 依 靠 微 电子 技术 的 进步 ,使 飞行 器 可 以 拥有 更 多 的 功能 ,从 而 有 能 力 执 
行 各 种 复杂 的 操作 和 任务 ,应 用 于 更 多 的 领域 。 

采用 新 的 能 源 。 使 用 高 效 的 新 能 源 能 够 减少 飞行 器 的 重量 ,增加 飞行 器 的 载重 ,从 
而 延长 飞行 时 间 。 

在 这 些 趋势 中 ,微型 化 使 得 四 旋翼 飞行 器 在 军事 和 民用 领域 都 有 广阔 的 应 用 前 景 ， 
根据 四 旋光 飞行 器 的 发 展现 状 和 相关 高 新 技术 发 展 趋势 ,预计 它 将 有 以 下 发 展 前 景 。 

未 来 的 微小 型 四 旋 辟 飞行 器 将 完全 能 够 达到 美国 国防 预 研 局 对 MAV (Micro Air 
Vehicle, 微 型 飞行 器 ) 基 本 技术 指标 的 要 求 。 它 将 是 一 种 有 4 个 旋 避 的 可 飞行 传感器 芯 
Hr ,是 一 个 集成 多 个 子 系统 (导航 与 控制 .动力 与 能 源 、 任 务 与 通信 等 子 系统 ) 的 高 度 复 杂 
MEMS 系统 。 不 但 能 够 在 空中 悬 停 和 向 任意 方向 机 动 飞 行 ,还 能 飞 临 . 绕 过 甚至 穿 过 目 
标 物 体 。 此 外 , 它 还 将 拥有 良好 的 隐身 功能 和 信息 传输 能 力 。 

微小 型 四 旋涡 飞行 器 的 编队 飞行 与 作战 应 用 。 单 个 微小 型 飞行 器 的 有 效 载荷 量 毕 
TETT PR ,难以 有 效 地 完成 任务 ,而 编队 飞行 与 作战 不 仅 可 以 极 大 地 提高 有 效 载荷 量 , 还 能 
够 增强 其 突 防 能 力 。 


[9] 
[10] 苏 建 志 , 王 冰峰 . FC 总 线 及 其 应 用 [站 . 现代 电子 技术 ,2004,(22): 22-24. 
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